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A microprocessor controlled prototype robot was designed 
and built to perform as an autonomous sentry and serve as a 
test vehicle for evaluation of appropriate sensors and their 
Besoeciated interface circuits. 

A ten channel near-infrared proximity detection system 
was developed for use in collision avoidance, with moderate 
range navigational planning incorporated through use of a 
sonar system operating in conjunction with a long range near- 
infrared detector. 

The system was provided with a means of locating and 
connecting with a free standing recharging station when 
internal sensors detected a low battery condition. 

A software structure was created to provide supervisory 
control of the prototype and produce a reasonably intelli- 
gent process of goal achievement through execution of 
ordered sequences, with provision to deal with unexpected 
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Tt. ih PRODUCTION 


The application of a microprocessor as a dedicated con- 
troller for a complex mechanical system eventually leads 
those concerned with the initial design or operation of the 
end result into the rapidly growing and not always under- 
stood field of robotics. This venture may be very brief, 
or considerably involved, ie Domain both on the desired 
system capabilities, and the willingness of the designer 
Peomecommlc more and more functions to computer control. As 
required human intervention decreases, the machine's abili- 
ties must simultaneously increase, giving rise to what is 
commonly referred to as ‘artificial’ intelligence. There 
exists at the one end simply a pre-programmed dedicated 
Pemeeroller able to repeatedly execute the most complex of 
Instructions and effect the motion of actuators, valve posi- 
tions, motor speeds, etc. On the other end of the spectrum, 
however, there are evolving machines that can function on 
their own, evaluating their changing environment, and react- 
ing as needed to carry out their intended tasks with no human 
intervention in such a way that they truly appear '‘intelligent'. 
The obvious question arising is "At what point do these 
machines become robots?". Unfortunately, there is no con- 
cise, universally agreed upon definition of a robot, ora 


means of identifying the transition point. No attempt will 





be made to add another definition to the many already in 
existence, as no purpose would be served in so doing, and it 
Ge) doubtful that there will exist any confusion associated 
with the use of the term robot in the following pages. 

The research presented in this thesis required the con- 
struction of a microprocessor controlled mechanical system 
to serve as a development and demonstration platform, and an 
a@etual robot was desired to fill this role because of its 
obvious impact already felt in many areas. Therefore such 
a system was designed and constructed to be used strictly 
eemea learning tool, with no attempt to provide the proto- 
Iege] With an outer protective skin. All circuits and inter- 
faces as well as the mechanical parts were to remain as open 
and accessible as possible without degradation of performance 
or risk of physical damage. For purposes of illustration 
this robot was given the assigned task of serving as a home 
sentry, patrolling in a normal household environment without 
human intervention. It was to be equipped to detect poten- 
tial dangers such as smoke, fire, toxic gas, flooding con- 
ditions, or intrusion, and then effect the necessary response. 
The system was not intended to be completely autonomous at 
first, but to evolve to that stage over a period of time as 
new techniques were developed, additional sensors added, 
E@emeene COncepts of artificial intelligence explored by the 


designer. 
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Once the decision is made as to the overall task (or com- 
bination of several smaller tasks) a robot is to perform, 
the actuators must then be provided to enable it to mechan- 
ically accomplish that task. The next step involves selec- 
meer Of the microprocessor(s) which will provide the control, 
and the sensors required to furnish the microprocessor with 
its needed information. As the design considerations begin 
to materialize the question of how much human interaction is 
needed or desired must be readdressed, and then attention 
turns to which points internal to the system must be moni- 
mored, such as voltage ievels, temperatures, current flow, 
peer ne design can then be successively improved through 
an iterative process until a reasonable solution is reached 
for implementation on the prototype. 

If the robot is to carry its own power source then energy 
conservation becomes critical in order to achieve a practical 
duty cycle relative to the time required to recharge the 
battery pack. Circuits which are powered down when not 
needed often will affect other systems which are still ener- 
Peem@eaeand any interconnection must take this into account. 
Backup or supplementary systems must be structured so as not 
memepmrovide conflicting information to the microprocessor, 
and any change-over must be smooth and orderly. Individual 
tasks must be prioritized to allow those of greater urgency 
to interrupt the less important routineswhich may be in pro- 


Big-s5, 1m Such a way that the CPU can pick up where it left 


tpl 





off or cancel the remainder upon return, as appropriate. 
Collision avoidance routines must be set up so as to maximize 
the use of the available sensory information, and provision 
must be made to react to impending collisions that arise as 

a result of evasive action initiated by a previous threat of 
Memlision. lhe concept of interrupts must be thoroughly 
understood by the designer, with much attention given to the 
details as applicable to the microprocessor chosen if the 
system's capabilities are to be utilized in the most effec- 


imevre Manner. 


A. DESIGN CONSIDERATIONS 

As indicated, the primary purpose of this robot 1s to 
serve as a mobile platform for research and experimentation 
in the areas of artificial intelligence, computer interface 


techniques, speech synthesis and recognition, and mechanical 


ememelectrical design. The initial design provided for the 
mottowing: 
1. Chassis and body framework with a tricycle wheelbase 


featuring a driven steerable front wheel. 

2. A rotating head assembly mounted on the body trunk, 
positionable up to 100 degrees either side of centerline. 
ee speech synthesis for communications with operator. 

4. Optical photocell array located in head for locating 
and tracking homing beacon on recharging station. 

5. Single transducer SONAR system for determining range 


to obstacles in immediate path. 


eZ 





6. Multi-element near-infrared collision avoidance system 
for object detection in first and fourth quadrants rela- 
five tO centerline. 

fee Contact bumpers and feelers for collision detection. 

8. Numerous sensors for intrusion detection and home 

surveillance. 

9. Complete software development system with hardcopy 

Eeinter. 

10. Provision to allow operator to request control from 

CPU for performance of trouble shooting ee emanco 

Bequest a specific behavior pattern subroutine. 

The size of the prototype was arrived at through consider- 
ation of several design requirements. The overall height was 
chosen so as to allow the machine to ‘'see' over most obstruc- 
tions likely to be encountered in a home environment, to 
Facilitate location of the recharging station, yet not so 
bees tO preclude the fabrication of two uprights from a 
mecmeadtead six foot length of aluminum angle stock. A body 
EeM@mennelehnt of 36 inches, with an additional 2 inches for 
Die@@emelearance, effectively situates the optical photocell 
array at 44 inches above the floor (see Figure 1). The addi- 
tional sensors mounted on top of the head extend the height 
to 57 inches, and the receiving whip antenna reaches up to 
a total system height of 62 inches. 

The width of the base was set at 15 inches to allow suf- 


Mmmetene Croom fOr the drive motors attached to either side of 
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Pace Ie EMOTO ©f the Prototype Robot ROBART 








the front wheel, and to provide a stable foundation for the 
body trunk. The two rear wheels are recessed into the side 
of the rectangular base to provide a smooth side panel rela- 
tively free of protrusions which would enhance the possibility 
of impact with surrounding objects. The base length is 26 
maenes Irom front to rear bumper, and the relatively narrow 
profile allows for easy navigation between obstacles and 
through doors. The tricycle wheelbase provides a minimum 
turn radius of twelve inches measured to the drive wheel of 
the vehicle, which translates to a required free radius of 
Meenenes in which to perform a turn without impact. The 
maximum turn angle is 80 degrees either direction. 

The tricycle wheel base was chosen for use on this robct 
primarily for comparison with a system employed on a previous 
prototype, which consisted of two separately controlled drive 
motors attached to the rear wheels, and caster type idilers 
used in front. The reader should not assume that the steer- 
able driven front wheel is preferred over alternative methods 


Meeen section V). 


fee EC ROPROCESSOR SELECTION 

Two microprocessors are used on the prototype robot, one 
to provide supervisory control and another totally dedicated 
memepeech synthesis. The first of these, a 6502 micropro- 
cessor, is located on a SYM-1 single board computer manu- 


factured by Synertek Incorporated of Santa Clara, CA. A 


abs 





functional block diagram of the SYM-1 computer is shown in 
Beeure 2. The SYM was chosen as the primary controller for 
the prototype due to the extensive hardware made available 
on a Single board, the availability of a superb Assembler/ 
Bemtor for software development, and a relatively low total 
package price. 

The 6502 utilizes a 16-bit address bus and an 86-bit data 


Te 


bus, and provision is made to utilize 4 Kilobytes of Random 
Access Memory (RAM) on board, as well as 28 Kilobytes of 
Read Only Memory (ROM). Three 6522 Versatile Interface 
Adapters (VIA) and one 6532 Peripheral Interface Adapter 
(PIA) are available on-board and together provide a total 
mameeminpuc/Output (21/0) lines, making the SYM ideal for 
mepetic applications. Throughout the rest of the text, the 
three Versatile Interface Adapters wlli be referred to as 
mee2—=1, 6522-2, and 6522-3. Their respective port assign- 
ments are given in Appendix A. Off-board expansion is pro- 
vided for through a 44-pin Expansion Connector, and 32 
Kilobytes of additional RAM are incorporated through the 
addition of Beta Computer Devices 32K RAM Expansion Board. 
The SYM-1 computer is mounted at mid-height on the 
meee Or the prototype, forming the heart of the electronics. 
emeeemetions primarily as a dedicated controller, but can be 
borrowed for interface to a Synertek KTM-2 terminal through 
an RS-232 connection, thus greatly expanding the practicality 


of the overall setup. The robot remains motionless beside 
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the terminal stand while the SYM is under KTM control, and in 
exchange receives supplemental power over the same DB-25 con- 
nector that provides the RS-232 link. Once released by the 
Operator, the CPU first verifies that this circuit has been 
disconnected, and then the robot proceeds under its own con- 
trol on battery power. In the event the connecting cable has 
not been removed, operator assistance will be requested 
through speech synthesis. 

Speech synthesis 1s implemented through National Semi- 
Semauctor's Digitalker DT1050 synthesizer chip, with two 
sets of vocabulary instructions stored on EPROMs for a total 
vocabulary of 280 words. (A third set will soon be avail- 
able.) A fixed vocabulary was preferred over an unlimited 
Weeaoulary created through repeated use of phonemes due to 
the greatly decreased demand on the host microprecessor in 
terms of both execution time and memory space. This also 
reduces the complexity of voice outputting a response to 
cnanging conditions as encountered by the robot when operat- 
ing under its own control. These considerations are espe- 
Clally important when designing a system that is based 
Seema a Single microprocessor. The SYM-1 CPU is inter- 
Faced to the Digitalker DT1050 through two parallel I/0 
Bees, One Of which supplies the EPROM starting address for 
the instructions needed to generate the desired word. The 
EPROMs are addressed by the DT1050 and do not take up address 


Space of the SYM-1. A portion of the second I/0 port is used 


iS 





fe@manitiate the speech output, and to detect completion of 
each word. The SYM-1l essentially just instructs the syn- 
thesizer to speak a particular word, and then checks later 
fons ce it the speech is complete before requesting the next 
word. 

The Subroutines Voxl and Vox2 request words from vocabu- 
Beye lists 1 and 2, respectively, just as Yox3 will deal with 
those words on list 3 when its associated EPROMs become 
available. The hex address of the desired word is first 
loaded into the X Register of the SYM-1, and then the appro- 
priate subroutine called (Voxl or Vox2). After the desired 
word is maentified, Subroutine Talk is called which manipu- 
Mees the control lines to the DT1050 to initiate the speech, 
and then waits for the busy signal on PB7 of 6522-1 to clear. 
Subroutines Voxld and Vox2d can be called if a slight delay 
is desired before outputting the word specified, for spacing 


between words ina sentence. 


PeeeeNTERFACE LAYOUT 

When used as a dedicated controller, the SYM-1l micro- 
computer communicates with the outside world through its 
Three 6522 Versatile Interface Adapters and the 6532 
Peripheral Interface Adapter. These each contain two par- 
feeereecight-bit input/output ports (Port A and Port 8B), 
which can be used to read sensory information or send com- 


Mamas tO external circuitry. Each 6522 contains a total of 
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sixteen internal eight-bit data registers, and is structured 
Semonown in figure 3. The organization of the 6532 is very 
Similar. For the purposes of this discussion the differences 
are insignificant and will not be addressed. 

As configured on the SYM, all sixteen registers appear 
to the CPU as specific memory locations within the 64 kilo- 
byte address space. The CPU reads or writes data from these 
registers on the VIAs as it would from any memory location. 
The assigned address locations for the specific registers in 
Sacn of the four input/output devices are given in the SYM-1l 
Reference Manual [Ref. 1]. 

For both Port A and Port B there 1s associated an elight- 
bit register referred to as the Input/Output Register, and 
Metis this register that the CPU actually reads from or 
writes to when communicating with the outside world. Each 
of its eight bits is directly associated with a hardware con- 
feeeron to one of the expansion plugs on the SYM-1 board. 

In the output mode, data can be loaded into this register, 
and these associated lines will assume the TTL logic level 
dictated by the subsequent register contents. For each bit 
that is high, the output line will go high, whereas each low 
bit will cause its associated line to go low, as shown in 
Figure 4. These registers can be incremented, decremented, 
Sryrotated by assembly language instructions, with the 


wemmagpe levels on the output lines reacting accordingly. 
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Figure 3. 6522 VIA Internal Architecture 
(courtesy of Synertek Systems Corp.) 
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Wiese Output lines can be directly interfaced to control 
solenoids, motors, lamps, etc., according to preprogrammed 
iieeructions executed by the 6502. 

In the input model the TTL voltage levels present on the 
lines associated with the Input/Output Register dictate the 
individual bit values within the register. Thus the state 
of a line can be determined by reading the register, and 
meemene off all but the desired bit with logical operations 
performed within the accumulator by appropriate 6502 commands. 

The two Data Direction Registers associated with each 6522 
VIA determine the mode of operation for each individual bit in 
the Input/Output Registers. If the processor writes a QO into 
Beparticular bit of the Data Direction Register, that same bit 


Will be configured as an input on the Input/Output register 


4 


or the same port (see rigure 4). Conversely, writing a 1 will 
Mei@ee tie pin associated with that bit to act as an output. 
eoyecomDination of inputs and outputs is possible on the same 
Perr . 

Meee remaining registers used on the 6522 VIAs are con- 
S-@iea@ with shift register operation, event timers, and inter- 
rupt processing, and an adequate discussion is not possible 
meee ihe reader is referred to Scanlon, "6502 Software 
Beemen" (Ref. 2], and Zaks, "6502 Applications Book" [Ref. 
Semmror excellent coverage of these details. 


Seer eeinitial design of the prototype begins to mater- 


jalize, it soon becomes apparent that the 71 I/O lines 
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Figure 4. Data Direction Register and Input/Output Register. 
Bits set high in the Data Direction Register configure corre- 
Seemeing bits in Input/Output Register as outputs. 





evertable on the SYM-1 microcomputer are insufficient, due to 
the vast number of inputs and outputs needed for autonomous 
control of a mobile system. Thirteen I/0 lines are needed for 
communication with the speech synthesis microprocessor alone, 
eight for head and drive wheel position control, five for an 
operator control interface, and sixteen for tactile sensors, 
to name but a few. 

Therefore a four line address bus was created to serve the 
Six interface boards which connect the CPU to the various sen- 
Bers and outputs under its control. This address bus is driven 
PyeePSO —- PB3 of 6522-1 (see Appendix A), and in turn drives 
three 74150 sixteen-input Data Selectors, two 74154 sixteen- 
Butput Data Distributors, and one 7475 four-bit latch (see 
Beeure 5). This yields an additional 84 I/O lines, but at 
meenexpense of 10 of the original 71 I/O lines. fif needed, 
Meaittonal groups of 16 Lines each could be added at a cost 
Seeteoriginal £/0 line per group. 

The three Data Selectors are simultaneously driven by the 
four line address as the CPU sets PBO - PB3, with the comple- 
ment of the selected input appearing on the selector output, 
pin 10. A detailed description of 74150 and 74154 operation 
Memeiven by Lancaster in his "TTL Cookbook" [Ref. 4]. For 
ease in programming, the selector outputs are again inverted 
before being read by appropriate inputs on the 6522 VIAs, so 
that the VIA sees the same logic level (high or low) as seen 


Dy the selector input. This inversion is done by a spare 
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Comparator on the quad LM339, used to implement a sixteen 
input NOR gate. A schematic of Data Selector A is shown in 
Faeure 6. 

The CPU therefore must set the value of the desired input 
number onto the four line address, and then read the appro- 
priate selector output over the corresponding 6522 VIA input 
(see Appendix A). As an example, to read the Target Input 
used in homing on the recharging station, the CPU must set 
the address lines to binary 0101 to select input number 5 
Smee tnree Data Selectors, and then read the output of 
Maea selector C over PA6 on 6522-3. Subroutines ReadA, 
ReadB, and ReadC take care of manipulating the address and 
data lines for ease in programming, with the desired input 
number loaded into the X Register before the appropriate 
BeerOucine is called. 

Pee Selector A is entirely dedicated to tactile and 
proximity sensors, and is interrupt capable (see Section 
Ii-8). Data Selector B also is interrupt capable, and 
gees cil alarms and internal circuitry check points. 

Data Selector C is used to read miscellaneous inputs and 
Mmesemo interrupt capability. A listing of all selector 
inputs is given in Appendix B. 

The two sixteen-output 74154 data distributors are also 
driven by the four line address bus, but require three addi- 
mena control lines, referred to as Data 1, Data 2, and 


Data 3 (see Appendix A). These three lines are normally 
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@epiigured except that C has no interrupt capability. 
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maintained in the high state. Data 1 and Data 2 provide the 
mers tO Data Distributor A and Data Distributor B, respec-~- 
tively. These lines can be sent low to pull down the desired 
Seer ibutor output. All sixteen outputs are normally high, 
feee-pe the selected output, which follows the applied input. 
Mamet t the inputs are kept high, no outputs will change state 
regardless of the status of the four line address. This is 
gmportant as this address also services other devices. 

Mmepche CPU desires to momentarily pull low an output on 
Distributor B, it first sets the appropriate binary value 
Mmeene four line address bus (0011 for output number 3, for 
example), and then momentarily sends Data 2 low. Output 3 
Smeeestributor 8 will also go low, but output 3 on Distri- 
pmer A, although selected, will be unaffected, since it 
Bemrows Data 1. It is important to note, however, that this 
emeaomecam only be used to strobe outnuts on Selector 8, 
and that they cannot be held low for any length of time 
without tying up the CPU. Therefore these outputs are used 
only as negative-going triggers to initiate timing sequences 
Semacetons subsequently controlled by other circuitry. 

Meee echird control line is used with Distributor A to 
overcome this problem and provide a means for latching the 
Pieeput Nigh or low. As shown in Figure 7, each output on 
Distributor A is used to clock a positive-edge-clocked D-type 
flip-flop. These flip-flops all have their D inputs commonly 


connected to Data 3. The output of any flip-flop will 
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therefore assume the logic level of Data 3 if and only if 
meee tlip-flop is clocked by Distributor A. The clocking 
sequence involves setting the appropriate address to select 
the desired flip-flop, with Data Lines 1-3 ene Data. 3. is 
then set to the desired output logic level (high or low). 
Meee. 1S then strobed to clock the flip-flop, and its out- 
put assumes and holds the desired state dictated by Data 3. 
No other flip-flops will change state, as only the selected 
memp—rt1Op was clocked. For a complete description of the 
7474 flip-flop operation, the reader is again referred to 
mem tTL Cookbook" [Ref. 4]. 

This rather complicated manipulation of address and con- 
mgemeeiines 1s all done by Subroutines Pin.hi and Pin.lo, 
which respectively set the address according to the contents 
of the X Register and then send the appropriate output high 
mameow. ror example, to turn on the robot's spotlights, the 
programmer would merely load the X Register with hex 01, 
Poeeenen call Subroutine Pin.hi, which would set flip-flop 
mmeer 1 output to high, enabling the spotlights. A iisting 
Seeeeere Distributor Outputs is given in Appendix B. 

The final device serviced by the four line address bus 
is a 7475 quad latch, used to store a four bit command for 
Metlemeositioning circuitry to be discussed later. This latch 
is level sensitive, and controlled by PB7 of 6522-2, referred 
Memes batch Enable. When this line is high, the latch con- 


tents will reflect the value of the four line address bus 


SU 





and subsequently hold that value when Latch Enable goes low. 
Maus any four—bit number can be latched into the register as 


a head position command. 


fee DRIVE AND STEERING CONTROL 

Ives prouoQrype roboOe 1s propelled by two surplus gear 
motors originally designed for use as valve ectuators. Each 
has a separate forward and reverse winding, with a permanent 
meemect field. Output shaft speed at 12 volts DC is 10 RPM 
under full load, yielding a forward velocity of approximately 
16 feet per minute. The two drive motors are mounted on 
either side of a single front wheel, attached to what will 
be referred to as the drive wheel support cage. This cage 
in turn is supported by a vertical steering column and thrust 
bearing in such a way as to be positionable by a steering 
motor up to 80 degrees either side of centerline. The entire 
drive assembly thus pivots around the steering column. Posi- 
£10n is sensed by a belt driven potentiometer mounted directly 
to the rear of the column. The steering motor is identical 
memthe two motors used for propulsion. 

The sensing potentiometer used for position feedback is 
wired as a voltage divider across a carefully regulated 95V 
supply, and positioned so as to provided a linear output 
Pamging from 0V to 3.7V, as the wheel turns from right to 
Meet. this voltage 1s fed to an operational amplifier for 


isolation purposes, and the amplifier output applied across 
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a 25 K potentiometer used to set the maximum output to 2.5 
volts (wheel full left). The output from this second poten- 
tiometer is fed directly to a National Semiconductor ADCO804 
analog to digital convertor (see Figure 8) located on Inter- 
meee Board Number 2. This A/D converter is supplied ina 20 
pin package, and in this application operates in the free 
running mode, with eight bits of resolution in a parallel 
@eeput. The chip is designed for an input voltage swing of 
feeero oY, and so the most significant bit is not used. This 
Mame riect creates an A/D converter with a range of OV to 2.5V, 
Mimeewith only seven bits of resolution. The unused bit should 
remain low during normal operation, and 1s wired to generate 
an interrupt if it ever goes high, indicating the system is 
MemLonger correctly calibrated, resulting in an A/D overflow. 

Due to monetary constraints, a@ rather simple positioning 
control system was chosen for use on the prototype, with sub- 
stitution of a more sophisticated version easily achievable 
if later desired. This simple control system required only 
Meure bits of resolution, effectively creating 16 discrete 
position points throughout the range of motor travel, approx- 
imately every 10 degrees. Therefore, the three least signi- 
Meant bits of the ADCO804 are not used. 

The four bits from the A/D converter are fed to the B 
inputs of a 7485 four-bit magnitude comparator, as shown in 
Figure 8. The desired steering position is fed to the A 


inputs directly from 6522-2, PAQ - PA3. The comparator 
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Figure 8. Steering Position Control Schematic 
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compares the two numbers and indicates via its digital out- 
puts if they are equal, or else which is the larger. The 
steering motor can be directly controlled by these same out- 
puts, as was done by DaCosta [Ref. 5] in a similar arvrange- 
ment which served as the basis for this design. The steering 
motor is energized as long as the actual position is not equal 
memene deisred position, and its direction is determined by 
which of the two is greater. 

Poepointed out, this is a relatively crude positioning 
scheme, with very coarse resolution, and no velocity control. 
Nevertheless it proved more than adequate for use in the 
homing and navigational routines presented later. Consider- 
able improvement could be obtained by ganging together two 
7484 comparators, and picking up the additional three bits 
Beitable from the A/D convertor, for a total of 128 discrete 
positions as opposed to merely 16. The upper two most signi- 
Mmeamt bits could be monitored with Exclusive-Or logic gates 
to control the speed of the motor as well, causing it to slow 
down to a reduced RPM when the upper two bits matched, stop- 
ping altogether when all bits matched. A proposed schematic 
mememown in Figure 9. 

A considerable amount of frictional damping is inherently 
present in this positioning system, which decreases the 
chances of overshoot, especially for the case of only sixteen 
discrete positions. As the resolution is increased, however, 


Overshoot becomes a significant problem, and some form of 
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velocity control becomes essential for stability. The ideal 
solution would perhaps be to use a small dedicated micropro- 
cessor to compare the desired position with the actual posi- 
meen, and control the motor velocity accordingly with pulse 

width modulation; continuously decreasing the motor speed as 
@etunetion of position error. Single board systems suitable 
for this application are available for less than $100. 

The tandem drive motors used for propulsion are wired in 
parallel to drive the steerable front wheel, and can operate 
in either forward or reverse directions. Due to their slow 
maximum speed, no attempt was made to provide velocity control. 
These motors were selected for their extremely low cost and 
high torque, and will be replaced by faster versions in a 
BOllOw on robot to be built based on experiences gained 
through this development. The drive motors are energized by 
a relay controlled by PA4 of 6522-2, and their direction is 


Similarly controlled by PAS of the same port. 


Peet aRRUPT ROUTINES 

The software structure for the prototype robot utilizing 
Pmiomoynertek Systems SYM-1 microcomputer as a controller can 
be broken down into three general areas. In addition to the 
main code which handles overall system control, there are 
two sections which deal with interrupts: the Non-Maskable 
Interrupts (NMI) and the maskable Interrupt Request (IRQ). 


Coordination among these three areas is made possible by 
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dedicating certain register locations in page zero (memory 
Bee@ress locations $0000 - S$00ff) for information fpane ten: 
mmeealso by the fact that input/output devices can be accessed 
from all three areas, not just the main code. A brief intro- 
duction to the concept of interrupts is required before pre- 
senting an explanation of the two types utilized on the 
peoLcotype. 

An interrupt is an event whose occurrence is hardwired to 
force the processor to drop what it was doing and service the 
cause of the interrupt. No polling of devices is required 
meer! an interrupt is detected. This leads to much more 
Mgicient Opareatilongeas the CPU need not concern itself with 
any interrupt sources until such time as they actually require 
Meeemtion. The CPU is alerted to this condition by special 
input lines connected to the hardware that it services - 

6522 Versatile Interface Adapters in the case of the SYM-l 
Single board computer. 

There are two interrupt input lines to the 6502 micro- 
processor. Each can be used to halt temporarily the program 
under execution and cause a branch to a different location 
mmemory. The processor then executes the program listed 
at this new location, which is referred to as the interrupt 
service routine. This action by the processor is termed 
responding to an interrupt. Quite often the processor 
Beaneches to a specific location that contains the starting 


address of the interrupt service routine, and then branches 
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again to that starting address. This allows the service 
routine to be located anywhere in memory, rather than being 
meeericted tO a specific address. This concept is referred 
to as 'vectored' interrupts, and the specific address where 
the processor goes to fetch the service routine starting 
address is known as the interrupt vector location. 

Two types of interrupts are possible with the 6502 micro- 
processor: the Non-Maskable Interrupt (NMI) and the Interrupt 
Request (IRQ). The Non-Maskable Interrupt can override the 
lower priority Interrupt Request, and will occur whenever the 
NMI line (pin 6) is pulled low on the 6502. It is edge sensi- 
tive, ecenring on themhigh, to low transition of pin 6, and 
cannot be internally masked by the processor. An interrupt 
Request, however, occurs when the IRQ line (pin 4) goes low. 
Unlike the NMI, the IRQ is level sensitive, which means that 
the processor will be interrupted as long as pin 4 on the 6502 
is held low. A second difference is that Interrupt Requests 
can be temporarily disabled by setting a flag within the 
be@eessOr, called the interrupt disable bit. This bit can 
be set through software, and when set, causes all subsequent 
Interrupt Requests to be ignored. (The Assembly Language 
Semimand to set this bit is SEI, and it is cleared with the 
Semmeamd CLI.) It is important to note that this bit is set 
automatically by the processor when responding to an IRQ, 
and cleared automatically when returning from interrupt 


(RTI). The programmer has the option of changing its statu 





as he so desires either within the interrupt service routine, 
or external to it. In any event, the condition causing the 
interrupt must first be dealt with before interrupts are re- 
mop led, or another interrupt will immediately occur, and an 
endless loop will result. The programmer has two options: 

1) Provide for eliminating the source of the interrupt 
through action initiated in the interrupt service routine, 
verify elimination, and then return from interrupt. 2) An 
alternate method would be to disable the device reading the 
interrupt (i.e., the hardware between the source and the 6502 
fee), then return from interrupt and attend to the source. 
Once the condition has been cleared, the hardware which 
alerts the CPU to an interrupt condition can be re-enabled 
for future use. Both methods are used in the prototype as 
presented later in the text. 

When a Non-Maskable Interrupt occurs, the processor will 
complete the instruction currently being executed before 
recognizing the interrupt, and then store the contents of 
the Program Counter and the Processor Status Register on 
the stack. The processor then goes to a specific address in 
memory ($A67A) and fetches the starting address of the Non- 
Maskable Interrupt routine software. In this manner the 
processor can be halted, the required information saved on 
the stack to allow a return, and then vectored to a new set 
Beeinstructions. Upon completion of these instructions, the 
Meeeessor can return and pick up where it left off, until 
interrupted again. 
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When an Interrupt Request occurs, provided the Interrupt 
Disable Bit is clear, the current instruction 1s again com- 
pected, the Disable Bit is set, and the Program Counter and 
Status Register saved on the stack. The processor then 
branches to a different address in memory ($A678) for the 
starting address of the Interrupt Request Service Routine, 
and subsequently jumps to that indicated portion of memory 
moreexecution of the instructions which deal with Interrupt 
Requests. 

peeecer the interrupt has been serviced, whether NMI or 
RQ, the processor returns to the location of the next in- 
struction to have been executed had the interrupt not 
eccurred. This is termed a Return from Interrupt (RTI), 
memes accomplished by pulling the Program Counter and Pro- 
cessor Status Register off the Stack, where they were pre- 
Peeuciy stored. Execution then begins where the processor 
teft off. Therefore, when routines are in progress where 
mmaits 1S Critical, such as while waiting for a sonar echo, 
the Interrupt Disable bit should be set to prevent a lengthy 
interruption at a critical point, and then cleared upon com- 
pletion of the routine. Any interrupts which may have 
occurred while the Disable Bit was set will be serviced as 
soon as the bit is cleared, as the IRQ line is level sensitive. 

The NMI line cannot be ignored by the processor under any 
conditions, and so NMI service routines should be kept as 


short as possible where there is a chance they could interfere 
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with other routines in progress. The Non-Maskable Interrupt 
is therefore used to keep track of the time, 1lncrementing the 
hours, minutes, and seconds registers as appropriate. Since 
it cannot be masked out, and has priority over Interrupt 
Requests, the accuracy of these registers is assured, and 
service time is kept at a minimum. These interrupts are 
caused by hardware circuitry located on the Clock/Calendar 
Board, as discussed elsewhere in the text. 

Mere LRQ line connected to pin 4 of the 6502 CPU can be 
pulled low by either of the three 6522 Versatile Interface 
meapeers, or the 6532 RAM I/O Timer (RIOT). Only one of 
these devices is used for interrupt handling on the proto- 
type robot, however, namely 6522-2. Each 6522 VIA has seven 
potential interrupt sources: four control lines, two timers, 
and one shift register. Only two sources are used: inter- 
rupts generated by Data Selector A (IRQ-A) are fed in on 
Gontrol line CA2 via AA Connector pin 4, and interrupts gen- 
erated by Data Selector B (IRQ-B) are fed in on control line 
CB-2 via AA Connector pin 5. These are referred to as Inter- 
rupt Channel A and Interrupt Channel B, respectively. Data 
eemector C has no interrupt capability. 

meen Data Selector has the capability to handle sixteen 
different inputs, any one of which can generate an interrupt. 
Diode jumpbers are installed on each selector input where an 
Bimerrupt 1S required, as shown in Figure 6, Section I-C. 
Data Selector A utilizes all sixteen inputs to monitor the 


impact sensor switches and the near-infrared proximity 
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detectors used for collision avoidance. All inputs are 
jumpered to cause an interrupt, but the four infrared inputs 
can be disabled at the infrared driver board so as to be ig- 
Mered, by calling Subroutine I/Rdis. Selector A interrupts 
can be collectively disabled, without affecting Selector A 
meyputs, by calling Subroutine IRQAdis, and enabled with Sub- 
routine IRQAen. Selector A is polled by Subroutine IRQA 
once an interrupt is detected. Data Selector B is used to 
memmeor internal circuitry check points, and not all inputs 
cause interrupts. Examples of those that do are the low 
Meaetery condition, analog to digital overflow, smoke alarm, 
meme alarm, and power distribution bus inputs. Selector 8B 
meepolled by Subroutine IRQB, for branching to the appro- 
priate service routine after returning from interrupt. (See 
sections on Behavior Selection and Alarms.) 

The Interrupt Request Service Routine first saves all 
primary registers on the stack. Next the Return Register 
is cleared, and the drive is stopped with the old command 
stored for later use. Subroutine IRQA is called for polling 
Beeeeoelector A, with Q (the IRQ index counter) initialized 
Memetart with input 4. The structure of Subreutine IRQA is 
Seemethat it will not return until alli inputs on Selector A 
are low (see Figure 10). Thus the individual service sub- 
routines called by Subroutine IRQA must clear the cause of 


Bees interrupt, or no return is possible. 
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Since Selector A reads collision related inputs generated 
Meeeither tactile sensors or the close-in proximity detectors, 
the service subroutines called must react by energizing the 
drive wheel to move the platform away from the object sensed. 
When all inputs have been restored to a low state, Subroutine 
IRQA returns to the Interrupt Request Routine, which then 
Bers Subroutine IRQB. Subroutine IRQB polls all inputs on 
Betector B in a similar fashion before returning, after which 
the Interrupt Request Routine restores the old drive commands, 
recalls the primary registers, and returns from interrupt. 

In addition to effecting drive motor responses within 
Mmese't, the [RQ Service Routine also causes actions to be 
performed after return by setting certain registers before 
returning from interrupt. Register Return will cause a 
Beeten trom interrupt even though all inputs on Selector A 
are not low, if set by Subroutine IRQA. Register Homing, if 
set, will cause Skirt to be activated during docking with the 
charger. A side impact at close range to the charging sta- 
tion will set Register Realign, causing Subroutine Align to 
be called when docking. These registers are predominantly 
addressed by Interrupt Channel A related software concerned 
with collision avoidance. As further examples, Register 
Exit can be set to ensure termination of a Behavior Subroutine 
in progress, and Register Next can be set to pick the subse- 
Seeme Sehavior Subroutine. This technique is used to process 
Ememreact to the alarm conditions generated by Interrupt 
Channel B. 
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Peewee ee UT ONCMOUS ROZOT SENTRY 


With the daily passage of time industry and the general 
public are becoming more acutely aware of the emergence and 
Mepential of the robot. From the vague definition of "machines 
that think" there are evolving a multitude of very sophistic- 
Beeadeand practically proven assembly line robots, and a back- 
ward glance at progress over just the past few years yields 
awesome visions of what the future may soon hold. With speech 
synthesis now an easily achieved reality, and speech recogni- 
tion showing much promise of the same, the potential of the 
robot to serve as a valuable assistant to man in areas beyond 
the scope of a controlled assembly line environment is becom- 
ing more and more apparent. The relatively new field of art- 
Mmempetal intelligence is now the subject of extensive and 
rewarding research. Robots which can function on their own, 
converse with humans, and move about performing tasks in 
toxic or radioactive areas otherwise inaccessible, are no 
longer merely conjecture but reality, and their numbers can 
Bemexpected to swell at a staggering rate. 

In the development of an autonomous system, the designer 
must address several fundamental areas after the initial 
decisions are made with regard to CPU selection, drive 
mechanisms, and structural framework. Of primary importance 


Should be the question of control. Very few systems will be 
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brought up on line with no human intervention whatsoever, 
particularly in the initial stages of development and up 
mereueh preliminary tests of the resultant product. Exactly 
how much human interaction is needed and how it should be 
implemented are questions that need to be resolved early. 

An intelligent mobile platform obviously needs to be 
provided with a real time reference to assist in the per- 
formance of its behavior routines, and various means are 
available through which both time and date information can 
be made available to the CPU. 

As a prototype begins to take shape from these meager 
beginnings the need for automatic replenishment of its 
energy store quickly surfaces. As battery power 1s cur- 
rently viewed as the most practical supply for indoor 
Operation, this usually requires the development of a 
tracking system to locate an available battery charging 
Station, and a means of effecting the proper connection. 

Since the platform must move about in the performance 
Stes Gities and,to ensure survival, an ability to navigate 
Paemavold collisions with surrounding objects 1s crucial. 
This is perhaps one of the larger areas of concern, and 
involves careful selection and placement of sensors as well 
as effective data utilization within the software. 

Once the capability to maneuver safely has been added, 
the refinement of the machine's ability to accomplish its 


overall objective becomes the dominant issue. In the 
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Bretotype robot ROBART this objective is to serve as an auto- 
nomous sentry in a standard home environment. Therefore con- 
siderable attention must be paid to methods of intrusion 
detection, as well as means to indicate the presence of smoke, 
fire, toxic gas, flooding, and other unwanted conditions, 

and the development of software routines to deal with each 
Seeevaction. 

Up until now the software associated with the concerns 
discussed could conceivably consist of reactionary subrou- 
tines which detect a condition and respond accordingly after 
Semeones a few appropriate inputs which dictate the response. 
As complexity grows, however, this means of control becomes 
severely limited, and unable to deal with unforeseen problems 
the machine is likely to encounter. A hardware and software 
meemerure for controlling the robot's actual motions must be 
developed that can support a higher level program tasked with 
determining what the machine's responses should actually be. 
At that point the device is ready to be provided with its 
Sam artificial, or machine, intelligence. 

In the following sections each of these fundamental areas 
Will be addressed as implemented on the prototype. The dev- 
elopment of the operator/machine interface is explained, 
followed by a description of the system's real time reference. 
The sophistication of the machine increases as the ability to 
locate and connect with a free standing recharging station is 


added, as well as collision avoidance capability. The 
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discussion concludes after examining the prototype's means of 
intrusion detection and the manner in which behavior routines 


are requested and subsequently performed. 


ee OPERATOR CONTROL 

Control shift between the CPU and the system operator is 
handled by the Subroutine Control, which when called checks 
li@emexternal input switches 1 through 4. If any of these 
switches 1S up, the CPU will initiate procedures to turn 
Ser control to the operator, otherwise the subroutine 
BeGurns with no action taken. 

Miemcontrol shirt procedure must make provision for 
several things: 

1) An effective yet simple method for determining if 

the operator desires to take control, or return control 

memche CPU. «; 

2) The passing of control at the appropriate points in 

ime program flow, so as not to disrupt the completion 

of events which should be terminated before other events 


are begun. 


3) An efficient method to determine which routine the 
Operator wants to perform or request. 


4) A means for inputting parameters or data needed to 
execute or clarify the chosen routine. 


iimeeoentrol 1s requested, Subroutine Control will perform 
fieeeemese functions, interacting with the operator through 
volce instructions. This makes the process fairly easy to 
follow, and requests are handled in aclear and orderly 
Memon. The CPU will first set the IRQ interrupt disable 


flag, stop the drive wheel, store the old drive command in 


48 





Meeister Dri.com, indicate that control is being passed to 
Mme serator, and then request the “Service Select Entry’. 
This is a four bit control code entered via the external 
[pee switches. The operator will be instructed to set the 
eseaeehes and then to press the ENTER button. 

Pressing ENTER triggers a 555 monostable multivibrator 
located immediately behind the switch panel, and the ENTER 
LED goes high. The 555 effectively debounces the push- 
Mepeeon, NOolds the ENTER signal high long enough tc be read 
(two seconds), and then resets. Meanwhile, the CPU calls 
Subroutine Ent.chk (entry check) to read the ENTER signal 
On PA? of 6522-3. This subroutine assigns the value of hex 
10 to Register Count ($06). It then aa PA7 every half 
meee. looking for a high, and decrementing Count each time. 
if PA7 goes high, or the Count register reaches zero, the 
Su@em@outine returns. On return, if Count equals Zero, there 
was no entry, and the request to enter is repeated. If 
Count is non-zero the CPU then reads the entry switches, 
which by this time have settled and thus require no de- 
bouncing. The four bit code just read determines which 
Bervice the operator is requesting, and is stored for the 
fame being in Register Ser.cd ($09). The CPU then requests 
Mem control Code Entry', which is inputted in a similar 
fashion and stored in Register Con.cd ($10). The Sub- 


routine Op.exec (operation execute) is then called to 
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/meesorm the required service based on the contents of Register 
Ser.cd, subject to the constraints represented by the contents 
meee cister Con.cd. 

There are fifteen Service Routines which the operator can 
request, and on the prototype robot these are primarily used 
bor trouble shooting the system or modifying its behavior. 

As an example, Service Routine Number 1 can be called to 

cycle Data Selector A and report by voice the input state 

as seen by the CPU. The ‘Control Entry' (contents of Register 
Con.cd) entered by the operator specifies the starting input 
merece test. Upon completion, the CPU will instruct the 
Seemeaeor to enter any desired changes in the ‘Control Entry'. 
The ‘Control Entry! will then be read and the original re- 
quested service again performed subject to the new constraints. 
Meas process will continue until the control code of zero is 
emeeered, which signals passing control back to the CPU. The 
Sem@erol! Shift is announced, and Subroutine Pl.dri (pull drive) 
is called which fetches the old drive command from Register 
Dr.com ($11) where it was saved, IRQ interrupts are re- 
enabled, and the CPU resumes where it left off before shift- 


Mento Operator control. 


Pee seal, TIME CLOCK 
The real time clock used by the system is implemented 
through software but derives its timing pulses from hard- 


Ware circuitry located m the clock calendar board in the 
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head. Here a National Semiconductor Clock/Temperature module 
is driven by a quartz oscillator via a seventeen stage divider 
(MM5369) which produces a precise 60 Hertz reference square 
meve. When its display 1s activated by the 3 volt DC supply, 
this module will display the time in hours and minutes on its 
own seven segment display. The temperature in either celsius 
or Fuhrenheit can also be displayed, as well as seconds and 
Eeeeem setting. The module provides only one digital output: 
Ppeel. This signal is used to drive a Dinary counter which 
Memncs from zero to six, and then resets. This count 1s 
displayed on a single seven segment LED located on the Clock/ 
Calendar Board, and represents the day of the week (Sunday = 
fe ine count is also parallel fed to Data Selector C for 
use by the CPU. The CPU has no direct way of reading the 
internal clock module registers to ascertain the hours, 
minutes, and seconds, however. 

To get around this problem, the 60 Hertz reference is 
Mento a Givide by 60 counter, to produce a one HertzZ square 
wave. This in turn is applied to the Non-Maskable Interrupt 
input on the CPU, and generates an interrupt once a second. 
The NMI Routine then increments the Seconds, Minutes, and 
mourns Registers in the appropriate fashion to duplicate the 
M@eernal registers in the clock module. If the CPU registers 
are first set to the time on the module display at system 
Start up, the NMI routine will ensure that the registers 


hold the accurate time, available for subsequent use by the 
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software. The Non-Maskable Interrupt routine also clears 
Seeteter IRQ.fre, which is used to keep track of the number 
of maskable interrupts per minute, each time Register Minute 
is incremented. This provides a useful piece of information 
for the collision avoidance routines as discussed later. 

The one HertZ square wave is essentially symmetrical with 
a 50 percent duty cycle, and its state (high or low) can be 
mea@amby the CPU over Data Selector C, as a more or less ran- 
dom variable for logical decisions throughout the software. 
An example is the random deletion of the word 'is' in the 
voice output generated by Subroutine Time to avoid constant 
repetition of the same phrase as discussed below. 

Subroutine Time is a speech synthesis program which out- 
puts the time in hours and minutes when called. The design 
intent was for speech output on the hour and half hour, with- 
out interruption of critical routines which may have been in 
Progress. Speech output is of the form: "The correct time 
is --- hours and --- minutes". A second consideration was 
cancellation of voice output after such time as the house- 
hold retired for the night. These two objectives are handled 
Peeoubroutine Clock. First, the NMI Routine, upon detection 
of either a ‘zero' or a 'thirty' in the Minute Register ($01) 
Will assign the appropriate speech synthesis address for 
that quantity to Register Timeflag ($04) (i.e., zero will be 
Meme thirty will be $15, on VOX1). The NMI Routine takes no 


Biemer action, bDesides periodically clearing Register [RQ.fre, 
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and keeping an accurate count in the time registers. Thus, 
the time required to service-a NMI interrupt is kept as short 
as possible. 

Subroutine Clock can now be called at appropriate times 
in the main program flow, when voice output of the time does 
mot interfere with other routines. This subroutine first 
checks the Timeflag Register, and returns with no action 
taken if the register contents are hex zero ($00). If either 
of the aforementioned speech synthesis addresses is encoun- 
tered, however, it is time to voice output the hours and 
minutes. Data Selector B is first read for ambient light 
conditions, and if the room is dark, no output takes place, 
and the subroutine clears the Timeflag Register and then 
returns. 

Marche room 1s mot dark, Subroutine Clock then calls Sub- 
routine Time which outputs the hours and minutes. The speech 
synthesis address for hours is read directly from the Hour 
meeesoter ($00). Since this register value is in decimal, 

a conversion to hex must be made for ten, eleven, and twelve 
Memock, for the speech synthesis Subroutine Voxld to function 
Gorrectiy. The address for the tens of minutes is read dir- 
ectly from the Timeflag register, where it was stored by the 
NMI Routine. Units, up to nine, are read directly from the 
mewer four bits of Register Minute. Upon return to Subroutine 
Clock, the Timeflag Register is then cleared, and Clock returns 


to the main program. 
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Subroutine Clock can be called from any appropriate point 
in the main program flow or in selected subroutines. Sub- 
routine Delay2c, used to create delays between routines, 
Calis Clock about once every half second throughout the 
delay period. The end result is that the NMI Routine is 
freed of all constraints addressed by Clock and Time, and 
the time registers will remain accurate. Additionally, 
P@eeeh CutLput is not triggered directly by the interrupt, 
and therefore willnot occur in the middle of a program 
routine already in progress. In most cases, the actual 
delay thus created between setting the Timeflag Register 
and the actual recognition and speech output of the time 
will not be more than a few seconds. Since seconds are not 
@UEput, no error will be noticed between the voice output 
and that of the LED Display on the clock module in the 
robot's head. 

As a further refinement, Subroutine Time checks the 
actual seconds count in the Seconds Register ($02), and if 
more than 15 seconds have elapsed, the word ‘correct' is 
deleted from the speech output. This also helps reduce con- 
stant repetition of the same phrase every 30 minutes. How- 
ever, if ten or more minutes have elapsed since the setting 
of Register Timeflag by the Non-Maskable Interrupt routine, 
the time is not announced, and Subroutine Time clears 


Register Timeflag and then returns. 
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C. AUTOMATIC RECHARGING CAPABILITY 

For a machine of this type to be useful operating in 
environments hazardous to humans, it not only must be immune 
to the hazards, but also able to support itself to a large 
degree. Of prime consideration will be the ability to re- 
charge itself when a low battery condition is imminent, thus 
freeing itself of the hindrance of an attached cable to ensure 
adequate power levels. Detection of the need to recharge is 
easily implemented, and the problem becomes one of how to 
locate and connect to a centrally located charging station 
(or stations). An extremely reliable process is required, 
one which is not rendered ineffective by unforeseen obstacles 
or changes in the robot's environment, and whose complexity 
does not overshadow the primary function for which the device 
Mmememployed. A self-sustaining robot becomes truly an asset 
when properly equipped with the required hardware and soft- 
ware to perform needed tasks in isolated reactor compartments, 
on unmanned offshore o11 platforms, and at contamination 
Sites, to name but a few examples. 

The requirements of simplicity and reliability effectively 
rule out the standard approach to the problem: trying to 
align a special plug on the robot with a mating receptacle 
on the charger. While this can be done, it requires rather 
complicated hardware as well as software, and is by nature 
Susceptible to complications. What 1s needed is a method of 


UG6eating the charger and making contact that is independent 
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of the direction of approach, requires no complicated align- 
ment procedures, and provides a good electrical connection 
every time. While this sounds like a tall order, a very 
effective solution can be realized quite simply. 
1. Automatic Scan and Track System 

Location of the charging station by the robot can be 
accomplished by any of several methods, but the requirement 
for high resolution with short range needs makes an optical 
tracking system a prudent choice. A visual homing beacon 
can be attached to the charging station in such a fashion as 
to be 'detectable' when activated by the robot via a radio 
Mm@mieeeas depicted in Figure 11. This beacon can consist of 
an ordinary incandescent lamp situated at the same height 
memmmeoe pnOococel! detector sensors on the robot or, better, 
a pulsed infrared source that can be distinguished through 
its unique repetition frequency by a tone decoder in the 
detection circuitry. The pulsed source eliminates the need 
Meera verification step in the software to allow the robot 
memescertain it is indeed looking at the correct light if 
an incandescent beacon is used. Since its light is invisible, 
a near-infrared beacon could be continuously energized, and 
sO the radio link could be eliminated. Having located the 
Charger, by whatever means, the robot must be capable of 
tracking the beacon while moving towards it. 

mi the prototype robot tracking is implemented as an 


integral part of the hardware circuitry which controls the 
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Figure ll. Free Standing Recharging Station. Beacon at top 
of pole is controlled by robot via radio link. 
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head position, located primarily on the Optical Board and 
Interface Board Number 5. The head positioning motor is 
directly controlled by the Optical Board, and Interface 
Board Number 5 evaluates the CPU commands in conjunction 
Meer Otner inputs to determine the control mode. This cir- 
Smptry (Figure 12) allows for three different schemes to 
Pontrol the motion or position of the head, referred to as: 
Mysecan mode, 2) track mode, 3) position mode. The control- 
ling mode is selected by setting the appropriate levels 
Memen or low) on the Scan Enable, Track Enable, and Position 
Enable lines, and special subroutines are provided to do 
this. A brief explanation of these three control modes 
follows. 

In the scan mode the head sweeps Dack and forth be- 
tween full right and full left positions, 100 degrees either 
Medeor Centerline. This action is controlled by the scan 
meep-L£lop on the Optical Board inside the robot's head. 

This flip-flop is set and reset by limit switches at both 
extremities of head travel, causing the motor to reverse 
direction each time, and the head to scan the other way. 
This mode is selected by Subroutine Scan which sets the 
Mean Enable line high, and the other two control lines low. 
When the Scan Enable line goes low, the head will be immo- 
mized, provided the Position Enable line is also low. 


All three lines are set low by Subroutine Scanoff. 
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If the Position Enable line is high, however, the head 
Peebieseek the position stored by the CPU in the 7475 four-bit 
latch on Interface Board Number 5. A 7485 four-bit comparator 
compares the command stored in the latch with the output of 
the head position A/D convertor, and positions the head accord- 
ingly, in the same way similar circuitry on Interface Board 
Number 2 positions the drive wheel. This head positioning 
Circuitry is automatically gated out whenever the Scan Enable 
line goes high. The latch is loaded from the interface four 
line address bus, and enabled by PB7 on 6522-2 (orb2). These 
Operations are automatically performed by Subroutine Latch, 
which takes the desired position command from the Y register. 
Thus the head can be made to center itself after a scan oper- 
ation, or to seek any of sixteen fixed positions on command. 


if boty rack 
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nable and Scan Enable are high with 
Pecm~eronm Enable low, then the system functions in the track- 
ing mode, and the head looks for, locks on to, and follows 
the homing beacon situated on the recharging tower. (The 
system will actually track any bright light source, and it 

is up to the software to ensure that this source is the 
beacon.) The tracking sensors consist of three photocelis 
arranged in a horizontal array on the head, each with a 

eee itich diameter collimating pick up tube 12 inches long. 
THe tubes are arranged in a diverging configuration (5 degrees 
Detween tube axis centerlines), with the center tube parallel 
to the forward axis of the head. The three tubes are shown 


at beacon level in Figure 13. 
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Mere 13. Photo of Robot and Recharging Station. Collimat- 
ing pickup tubes for photocell array are located at beacon 
height on front of head assembly, shown here turned slightly 
towards beacon. 





The Optical Board provides three digital outputs per- 
Mement to the tracking process: 1) Target Output, 2) Point 
Source Output, 3) Range Output (see Figure 14). The Optical 
Board Target Output goes high if any of the three comparators 
associated with the photocell array goes high, while the Point 
Source Output reflects the status of the center photocell com- 
Bemator only. The Range Output indicates relative distance 
from the homing beacon, as discussed later. Thus the CPU 
communicates with the hardware tasked with tracking the beacon 
ewer a cOtal of six lines: three control and three output. 

The tracking process 1S initiated automatically by a 
Bowe Dattery condition through alteration of the Behavior 
Selection procedure in such away as to terminate the routine 
in progress. When the battery condition goes low and remains 
Below the set point for more than 5 seconds, a flip-rlop on 
the Monitor Board changes state and triggers an interrupt. 
Tne IRQ routine which handles the Channel B interrupts dis- 
ec the low battery interrupt, and sets Register Next to 
select the docking routine (see section on Behavior Selection 
and Alarms). The transmitter which turns on the homing bea- 
Con 1S activated, and the CPU enables the Automatic Scan and 
Tracking circuitry, while sending the Position Enable line 
low. The head begins to scan left and right, seeking a point 
memeece Of light of sufficient intensity to trigger the photo- 
Get! comparators. This action continues as long as Scan 


Enable and Track Enable are held high by the CPU, and no 
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Figure Peo ptlcal Board Circuitry Schematics Controls head 
position in one of three modes as determined by Interface 
Board Number 5 (Figure 12). 
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Mesa source is detected. If any of the three optical conm- 
parators Beco ite ss indicating acquisition, the scan flip- 
flop is gated out automatically, and the tracking inputs take 
over control of the head positioning motor. 

Mie te aeming InpurcSs Loutne optical board circuitry 
Beme from the left and right photocells in the array. Their 
Respective comparator outputs (Figure 14) indicate a greater 
fight intensity either side of center, referenced to the 
center photocell output. The appropriate positioning motor 
Winding is energized, and the head turns to regain maximum 
Mimensity at the center photocell, thus tracking the source. 
meemby Chance both left and right photocells showed intensi- 
ties greater than center, both inputs are gated out and the 
head remains motionless.) All this happens only if at least 
one of the photocell outputs is above the adjustable set 
See provided by the Background Light Bias Circuitry on 
the Optical Board, otherwise the system reverts to the scan 
mode and searches for a bright light source. Any comparator 
Output signalling intensity above the set point gates out 
the automatic scan, and the tracking inputs take over. When 
bie array outputs indicate the head is correctly positioned 
(pointing at the source), the motor windings will be 
de-energized. 

The three collimating tubes limit the photocell fields 
of view to relatively small regions, and the beacon is situ- 


meead at just the right height so as to be centered vertically 
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within the detection zone when one of these tubes is pointed 
Bt the recharging station. This results ina relatively high 
Signal to noise ratio as the head scans back and forth in 
Meee Of the beacon, as shown in the stripchart recording of 
mere 15. The sharp peaks resulting from beacon acquisition 
readily stand out over the signal produced by ambient light- 
ing during the sweep. 

Meee Saekeround Light Blas: circuitry is tasked with 
providing the comparators with a reference voltage above 
Gomem photocell output is probably due to a point source of 
sufficient intensity to possibly be the homing beacon. The 
initial design provided for a bias potentiometer to manually 
Set the reference level. This proved inadequate due to over- 
MeMeicivity in close to the beacon. If the bias threshold 
was set low enough to allow detection of the beacon at long 
range, then the system saturated in close and all comparators 
went high when the pickup tubes were pointed in the general 
direction of the light. What was needed was a means of re- 
ducing the sensitivity from that needed for long range detec- 
tion, as the robot approached the recharging station, to a 
level yielding good bearing resolution in close, where 
accuracy became critical. 

The circuitry employed on the prototype basically 
provides for two manually set reference points, one to allow 
Surficient sensitivity for long range detection and a second 


With greatly reduced sensitivity for short range use, to 
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ks resulting from beacon acquisition at ranges of 3, 
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force the tracking system to point the head directly at the 
meoht. This one MUG MOP raeecl rate ybearings to the bea- 
eon for the purpose of docking with the recharger. A fourth 
comparator monitors the center photocell voltage output and 
effects the changeover when its output signals the robot is 
within three feet of the beacon, based solely on the perceived 
Meee intensity (Figure 16). This comparator output is also 
made available to the CPU (Range Output), and is used in many 
software routines to determine relative range (near or far) 
to the charging station. 

Onee the CPU ascertains that the head has a lockon 
(the Target Output goes high), it must interrogate the source 
to verify that it is indeed the beacon. Verification is 
accomplished by setting the Scan Enable low, and then turning 
off the beacon with the radio transmitter, observing to see 
if the Target Output line went low. An incorrect source will 
keep the Target Output high. The Scan Enable is set low so 
the head will not start scanning again if the source does go 
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out, and the Position Enable must also be low so the head 
Will not seek the position dictated by the contents of the 
[yo latch when the Scan is set low. If the source is not 
the beacon, the CPU sends the Track Enable line low so the 
source will be ignored, sends Scan Enable high to reinitiate 
the scan, and waits as the head turns for the incorrect 


source to clear (Target Output goes low). As soon as this 


happens, Track Enable is sent high again, and a new source 
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Meeure 16. Background Light Bias Circuitry Schematic. 
Range Output is used to indicate relative distance to beacon 
(near or far). Bias to three optical comparators changes as 


robot approaches recharger, thus decreasing system sensiti- 
vity and preventing saturation in close. 
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is sought. The process repeats until the correct source is 
Found, until three incorrect sources have been interrogated, 
or until a specified time limit has elapsed. The latter 

two indicate that the beacon is not in the immediate scan 
field (first and fourth quadrants relative to centerline), 
and the robot will perform a Y-turn and check the other side. 

Once the beacon has been located and its bearing and 
relative range announced through speech synthesis, the robot 
begins to home in on the recharger. The CPU repeatedly reads 
the head position, representative of the bearing to the charger, 
and sends an identical command to the steering motor via 
Interface Board Number 2. As the robot turns, the head auto- 
matically tracks the source, and the relative bearing to the 
beacon decreases. The CPU therefore is subsequently decreas- 
ing the turn angle, until eventually the source is directly 
in front of the platform, and the drive wheel is centered. 

A four-bit analog to digital conversion of the poten- 
tiometer output voltage which represents the head position 
yields sixteen possible head positions, evenly distributed 
around the 200 degree arc of scan. This produces cone shaped 
sectors every 12.5 degrees, and this resolution is far too 
coarse to precisely fix the beacon position as required for 
successful docking with the charger. Therefore the potentio- 
meter output was conditioned to yield the modified output 
shown in Figure 17, which in effect compresses the resolution 


into the center of potentiometer travel, where the head is 
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Meemting directly ahead. The output of the signal conditioner 
remains at zero volts until the sensing potentiometer voltage 
exceeds 1.0 volts, at which time it increases linearly with 
M@eninput voltage from the pot. The output voltage is clipped 
at 4.0 volts, and remains constant as the input voltage con- 
tinues to increase. This output voltage is then attenuated 
femexactly 2.5 volts at maximum output and applied to the 

Pe weconvertor, which produces a Dbinary output ranging from 
Meer lo (0000 to llll). 

As a result of this conditioning any head position 
from extreme right to 45 degrees right is seen as position 
feeand Similarly any position from 45 degrees left to full 
left is read as position 15. The other 14 sectors are evenly 
distributed over the remaining 90 degrees, 45 degrees either 
side of centerline. This greatly improves the resolution in 
the center of the scan where accuracy is needed for homing on 
the charger. 

mee Docking System 

The task of making contact with the recharger can be 
@eeatly simplified if the circuitry involved is restricted 
to that associated with the battery voltage, 12 volts for 
example, as opposed to the more dangerous 117 volts of a 
normal AC distribution system. The lower voltage level 
allows for contact surfaces to be exposed with no electrical 
Shock hazard. If these exposed contact surfaces are made axi- 


symmetrical with respect to the vertical pole which supports 
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the visual homing beacon, they will present the same target 
memtne mating contacts on the approaching robot, regardless 
Memehe direction of approach. Thus the need for a critical 
alignment to ensure contact is eliminated. 

Two connections must made to complete the recharge 
circuit, and will be referred to as HOT and GND. For reli- 
fees ty the connecting or mating actions of the two should be 
independent of each other. This can be accomplished by 
making their respective contact axis lines perpendicular to 
mem@ierotier, analogous to the orthogonal cutting directions 
used to isolate two channels in recording a stereo disk. 

For example, the contacts associated with the GND leg are 
brought together by a relative movement in the horizontal 
plane, whereas those associated with the HOT leg are brought 
together by a relative movement in the vertical plane. Thus 
the first set of contacts to meet does not impede the motion 
required to close the gap at the other set, and chances of a 
good connection at both points are greatly increased. This 
meme the concept, a slight modification (discussed below) 
Will preserve the required independence while requiring 
movement in the horizontal direction only, which need be 
only the inherent motion of the robot as it closes on the 
recharging beacon. 

Mimenie sactual Gonstruction of a test prototype for 
this concept, the metal pole supporting the optical homing 


Berleon served as the point of contact for the GND leg, its 
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respective mating surface being the front bumper of the robot 
chassis (see Figure 18). This front bumper was spring loaded 
to allow it to absorb impact and make possible the closure of 
numerous microswitches used as sensory inputs for collision 
detection. This already present spring action serves to keep 
Mee aluminum bumper in tight contact with the vertical pole 
once the two come together, compressing the springs. Once 
the bumper springs are thus compressed, horizontal motion of 
meewrobot must be halted. This condition is indicated to 
fmmewcontrolling microprocessor by closure of the contact 
sensing microswitches activated by the front bumper, in 
Conjunction with the signal indicating that recharging power 
ms sensed on board. 

The connection for the HOT leg of the recharge circuit 
is made through the mating of a circular aluminum plate at 
the base of the beacon tower and a set of spring probes 
attached to the front drive wheel support cage on the robot. 
The aluminum plate is electrically insulated from the ver- 
tical pole which serves as the GND connection by a plexi- 
glass insulator between the plate and the half-inch pipe 
flange into which the upright pole is screwed. The spring 
probes which mate with the circular plate are vertically 
Ccriented in such a way as to extend downward from a small Dox 
Situated immediately behind the front bumper. As the bumper 
passes over the plate moving toward the pole, the spring 


Peobes are brought into contact with the aluminum plate, 
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Pmad contact 1S maintained as the motion continues toward bumper 
mipaet. AS soon as the bumper contacts the upright pole, the 
circuit is completed, and recharge current flows to the bat- 
Men An electrical relay is connected across the circuit on 
the robot so as to de-energize the forward windings of the 
drive motors when final connection is made. This serves as a 
backup for the software which also de-energizes the drive wheel 
when the recharge probe potential goes high with respect to 
electrical ground. 

Mie econ curation Of the two necessary contacts for 
the recharge circuit thus ensures the required independence 
While requiring motion in only one plane, and the use of mul- 
tiple spring pick-up probes in the HOT leg ensures a good 
connection with low current density at the mating surfaces. 
i@ewsoftware can monitor the probes as well as the battery 
level while the system is recharging, and should electrical 
Bemeact be lost, effect the necessary forward motion to re- 
Establish the connection. In extensive testing of the proto- 
type, this has not been necessary to date, primarily because 
the spring loaded bumper provides the necessary force to 
keep the surfaces pressed tightiy together. The geometry of 
miemeontisuration 1s such that the probes will be in contact 
with the plate as long as the front bumper is touching the 
vertical pole, and since the front bumper for the prototype 
1s 14 inches wide, considerable margin for error is allowed 


Beemeracking system which brings the robot into contact with 
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the beacon tower. Even a very simple and inexpensive photo- 
electric tracking system homing in on an ordinary 75 watt 
rent bulb produced final impacts within two inches either 
side of centerline in repeated testing Cover 200 computer 
controlled dockings to date). 
foe Recharging System 

There are two power supplies associated with the re- 
Sewarging station itself. A relatively low power twelve volt 
source remains energized at all times, and supplies the re- 
ceiver and decoder circuitry which activates the beacon on 
demand from the robot. It also energizes the aluminum base 
plate through a resistor capacitor network to a peak poten- 
fear Of 16.5 volts, which acts as the 'sensing' voltage for 
the pickup probe, allowing the microprocessor to know when 
the recharge circuit has been completed. As soon as the 
Beeecery has been connected as a load on this supply, this 
voltage level will drop to just slightly over the battery 
voltage (around twelve volts). This voltage drop is sensed 
Beeo@etection circuitry on the recharging station, which in 
turn activates the high power battery charging supply, 
located just below the receiver board. This second supply 
furnishes the current required to recharge the battery, and 
is automatically shut off when the robot disconnects and 
the load is no longer sensed. The robot can deactivate the 
Deacon via the radio link once initial contact has been made 
and the recharging process initiated, without affecting the 
Beeharger supply. 
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Ile sGO@SO= Ss battery Voltage is monitored by an LM339 
comparator, which sets a flip-flop after a five second delay 
when the voltage falls below an adjustable set point (see 
Figure 19). The delay is used to ensure the battery voltage 
was not momentarily pulled low by a stalling-drive or steer- 
ing motor. When the flip-flop changes state, an interrupt is 
generated which is read by IRQ Channel B. The interrupt 
routine subsequently gates out the flip-flop output, and 
selects the docking routine (see section II-F). 

jie battery voltage 13 alse monitored by an LM3S14 Dot 
Display Driver, which drives 10 LEDs to give a visual indica- 
pon Of the battery charge. The upper LED in this display 
drives another comparator which subsequently changes state 
when the battery is fully charged, as indicated by the dis- 
play. This upper set point is also adjustable (see Figure 19). 

This entire concept has been tested throughout various 
stages of completion over the last twelve months, and is cur- 
rently operational in a fully computerized robot system fea- 
Pitieine automatic battery level monitoring, station location 
and tracking, and subsequent recharging. The system has 
proven an extremely reliable and easily implemented solution 
tO a problem that must be dealt with if computer controlled 
robots are to achieve the degree of freedom necessary to 


perform tasks in isolated or dangerous environments. 
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meeure 19. Battery Monitor Circuitry Schematic. Low voltage 
Condition sets flip-flop (4027) after 5 second delay created by 
995 timer. LED display gives visual indication of battery vol- 
tage level. Fully charged battery is detected by LM339 compar- 
ator connected to upper LED. Zener diode establishes display 
meamce lower limit of 9 volts (all LEDs off). 
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me COLLISION AVOIDANCE 

The prototype rebot makes use of a six level scheme of 
proximity and impact detection, implemented through numerous 
sensors installed at appropriate points on the chassis struc- 
ture. An active source near-infrared parabolic dish detector 
mounted on the head provides reliable detection of objects 
out to a range of five feet, with good bearing resolution 
(two inches of arc at maximum range). Additional long range 
eieOMrmation is provided by a forward looking sonar and a ten 
channel active near-infrared proximity detection system pro- 
vides close-in protection (out to about eighteen inches). 
Maerile sensors consisting of projecting feelers at critical 
points around the base periphery sense impending collisions, 
and contact bumpers situated all around the base and body 
Hrunk alert the CPU to an actual impact. As a final backup, 
miemari ve motor current 1s continuously monitored for an over- 
Memteecondition, indicative of a stalled motor. 

The software dealing with all of this sensor data is 
currently divided into two basic groups, IRQ interrupt rou- 
tines, and the main program. The main program handles the 
Navigational control of the robot and it is here that the 
actual planning takes place as required to proceed from 
place to place in the accomplishment of a desired task or 
goal. All information available from whatever source is 
Meea tO this end, and navigational routines are written in 


loop form to facilitate repetitive polling, sonar activation, 
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and delay timing, with the appropriate exit requirements built 
into the loop. Loops can be cascaded as needed in the execu- 
tion of complex navigational routines. Conversely, the soft- 
ware associated with the collision avoidance interrupt 
routines deals primarily with the sensor data depicting the 
robot's immediate or close-in environment (such as short 
range proximity detectors, feeler probes, and impact sensors) 
and minimal planning is involved. The contents of certain 
registers can be changed by the interrupt routines, however, 
to alter the planning processes of the main program after a 
return from interrupt (RTI). This provides the necessary 
link for communication between the interrupt routines and the 
main program and leads toward a more intelligent means of 
navigation. 

The ideal situation would be to have the long range plan- 
ning executed by the navigational loop be so effective as to 
make interrupt generation by close-in contacts a rare occur- 
rence, but this would require more numerous long range sen- 
sory inputs than currently affordable on this prototype. 

It is not meant to imply that this method of data analysis 
for collision avoidance is preferable or recommended for 
implementation on other systems of greater sophistication: 
it merely lends itself well to low budget applications in- 
volving a minimal number of microprocessors. 

The six methods of detection can be broken down into 


Beeee basic categories: 1) ranging, 2) tactile, and 3) internal. 
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Category 1 inputs are read by the software making up the 
navigational loop being executed with the resultant data 
used to alter course ina planned fashion. Examples are the 
sonar and the long range near-infrared parabolic dish detector 
on the head. Also in Category 1 would be the numerous short 
range infrared proximity detectors, but their inputs are used 
to generate IRQ interrupts to which the vehicle responds in a 
preprogrammed reactionary fashion designed to clear the de- 
tected obstruction, based on the obstruction location. These 
responses are implemented within the interrupt routine, upon 
completion of which control is passed back to the navigational 
loop, but with the robot hopefully now clear of the obstruction. 

Category 2 includes the feelers and contact bumpers, and 
these also generate interrupts which move the vehicle away 
from the impacted object. 

The drive motor overload sensor falls into Category 3 and 
Serves as a last resort detector, generating an interrupt 
which reverses the drive wheel and assigns a random steering 
command to the motor, in hopes of clearing the obstruction. 
Upon completion of the appropriate pre-programmed interrupt 
routines, the original drive motor command is restored to the 
controlling circuitry, and the robot proceeds as before. 

The original collision avoidance system consisted of a 
Sener Operating at 21 KHz, built up around National Semi- 
Semauctor's LM1812 monolithic sonar transceiver chip as 


shown in Figure 20. Circuit operation is described in 
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detail by Frederiksen and Howard [Ref. 6]. This sonar pro- 
vided range information - objects directly in the robot's 
m@meended path of travel, and was backed up only by the con- 
mee Dumper system for impact detection. Initial tests 
mmmakly showed the need for greater awareness of the path 
environment than that provided by sonar data alone, as the 
LM1812 system was somewhat limited. Although large objects 
such as walls and furniture were reliably detected, smaller 
objects often passed unnoticed below the beam pattern. 
Additionally, no information was provided as to which direc- 
tion was preferable for a course alteration, since the sonar 
transducer was mounted to the chassis in a fixed orientation, 
Pee nO capability to scan back and forth. 

The first attempt to gather additional information in- 
volved the installation of numerous feeler probes around the 
perimeter of the robot base, each extending out six to eight 
inches, and configured so as to provided a normally high 
mefecompatible output, which went low if deflection was 
sensed in any direction. These units were constructed from 
ordinary automobile curb feelers and were flexible so as not 
to cause damage to either the chassis or objects encountered. 
The intent was to provide advanced indication of an impact 
in time to alter course, supplementing the data obtained 
from the forward looking sonar, and indeed it did provide 
much improvement, although still crude. Some problems arose, 


however, from the inertia of the feelers themselves causing 
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false activation of the detection circuitry as they were jarred 
during vehicle motion and acceleration. The original software 
Seremset Up in the form of a loop which activated the sonar for 
transmission, timed the returning echo for object range, and 
then polled the feelers and bumper switches one at a time for 
contact, taking evasive action if called for. 

Peeurcther refinement came with the installation of four 
near-infrared transmitter/receiver units for proximity detec- 
tion, oriented so as to provide information on obstacles 
directly in front of, behind, and to either side of the 
vehicle, but only within their limited areas of protection. 
(Each sensor covered a cone shaped region roughly twelve 
inches out, with a base diameter at maximum range of approxi- 
mately six inches.) Nevertheless, these sensors proved to 
be extremely effective in detecting objects within their 
mera Of view, and their relative simplicity and low cost 
made it possible to add six additional units to increase the 
coverage area. This at the same time increased environmental 
awareness by better establishing an object's location, as 
Opposed to merely detecting its presence. Nine of the ten 
units were placed in the first and fourth quadrants relative 
to the vehicle centerline, for forward protection, as the 
Seajericy Of motion is in the forward direction. Additionally, 
when collision avoidance routines do call for reverse motion, 
the vehicle backs into space just previously vacated, and 


so the odds of a rear impact are greatly reduced. 
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inemovementus tO the Original detection circuitry ulti- 
mately provided an increase in maximum range from twelve 
inches to thirty inches, and attenuators were added to each 
detector to allow setting individual ranges and for balanc- 
Mm@emwith other units. Circuit operation is explained in 
Appendix D. Detectors mounted in a vertical row for the 
purpose of increasing their field of coverage are simply 
hardwired to the same input in an OR configuration, while 
Meese that provide horizontal resolution of the object loca- 
tion are kept separate from each other and read individually 
or as vertical groups. These devices performed so well that 
many of the tactile feelers were no longer needed and were 
subsequently removed. 

The availability of this new sensor information to the 
CPU made possible more intelligent reactions to impending 
collisions, but at the same time rendered the polling rou- 
tine too cumbersome and slow to be practical. At this stage 
Saecevelopment Interface Board Number 2 was completed to 
meow the generation of two channels of interrupts, with 
up to sixteen inputs each, referred to as IRQ Channel A and 
IRQ Channel B. Data Selector A which read the inputs asso- 
Clated with Channel A was totally dedicated to collision 
avoidance devices (see Section I-E). The software was re- 
structured around the interrupt concept, leaving the CPU 


more time for long range planning. 
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Mite iorward looking proximity detectors are set fora 
maximum range of about eighteen inches to give sufficient 
time for course correction, while the side sensors can see 
out to a distance of only twelve inches, since less time is 
needed to react should they detect a return. The design 
goal was to keep the protection envelopes as small as pos- 
sible without compromising performance, to allow passage 
down narrow hallways and between obstructions. Too great a 


detection range substantially reduces the vehicle's per- 


t 


ceived clear space wherein it can navigate, with the result 
that much time is spent turning circles in the center of 

the room, unable to exit via a doorway. Even with reduced 
ranges, situations are sometimes encountered which leave the 
robot 'boxed in', finding itself trapped between two obstacles 
and perhaps an adjacent wall. Interrupts generated by in- 
frared returns detected from several sides at once can 
essentially hinder an orderly exit from this predicament, 
and what is needed is a means of drawing in the protected 
envelope until out of this tight spot. There are a number 
of ways this can be done and the simplest solution was 
chosen for implementation on the prototype: simply ignore 
the near-infrared proximity detectors. An even better plan 
would call for reducing the receiver sensitivity by a factor 
of two to draw in the envelope as a first step, followed by 
disabling the receivers altogether as a final resort. This 
could be easily implemented as a minor hardware change to 


mie threshold detector circuitry. 


86 





Less obvious is the problem of how to detect that the 
fmeagetion exists in the first place; 1.e., how does the 
mebet Know that it is boxed in? The information needed to 
make this decision can be extracted from data mee is already 
available in memory by appropriate software. The first in- 
dication of a problem of this type would be an excessive 
number of interrupts within a given time frame, say 30 seconds, 
triggered by infrared returns, feeler and possibly bumper 
Mmeects. This is easily calculated by incrementing a regis-~ 
ter (register irq.fre) each time a collision avoidance re- 
lated interrupt occurred, and repeatedly clearing this 
register at specified intervals in real time. (This register 
clearing is done automatically by the Non-Maskable Interrupt 
(NMI) routine each time the minutes register is incremented.) 
Thus, if the register value ever exceeds a specified limit, 
then the interrupt frequency has exceeded that same limit, 
Since the register is reset to zero every sixty seconds. 

This register can be checked by the IRQ interrupt service 
routine each time called. 

A second piece of information is needed to verify that a 
problem does indeed exist, as an excessive interrupt fre- 
quency could arise when the robot is navigating a hallway 
merely from the side returns, without the vehicle actually 
being boxed in. It was found that tight situationsalmost 
invariably were accompanied by rear bumper impacts, which 


Otherwise seldom occurred, as the majority of motion is in 
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me forward direction. So a combination of too many inter- 
mPupts plus rear bumper contacts is used as the governing 
eriterion and the IRQ service routine responds by disabling 
the near-infrared proximity detectors. This allows the 
robot more manuevering room free of interrupts, and thus it 
frees itself from the trap, relying on tactile sensors alone 
for guidance. The infrared sensors are later re-enabled by 
the navigation loop under execution, after a precalculated 
delay. 

An improvement to this scheme would consist of disabling 
Only the interrupt generating capability of the infrared re- 
ceivers, rather than collectively disabling the receivers 
themselves. This would allow the sensor data to still be 
available to assist in a non-interrupt controlled decision 
as to which direction was best suited for an exit. That 
this feature would be desired was not clear at the time 
Interface Board Number 3 was constructed, and the modifica- 
tion was deferred to a later date. 

The collision avoidance interrupt software must take into 
account the overall goal of the navigational routine under 
execution when taking evasive action to avoid an impact. 
When docking with the recharging station, for example, this 
evasive action should not cause the robot to lose sight of 
the homing beacon. The robot must also be able to tell when 


Seeeeurn from a forward looking proximity detector is due to 
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the presence of the recharging station itself, so that the 
mmcerrupt software does not try to steer the platform away 
from the battery charger with which it is trying to connect. 
The docking routine therefore sets Register Homing to 
indicate that a docking 1S in progress, and this register is 
first checked by the interrupt routines before a response is 
made. Subroutine Skirt can then be activated by the inter- 
rupt routines to effect obstacle avoidance and subsequent 
realignment with the beacon by the navigational routine 
itself, rather than by the interrupt routines. When sub- 
routine Skirt 1s activated, the robot responds by backing 
away from the charger, and turning until the beacon is 
positioned 930 degrees right of the forward axis. Then for 
a predetermined time the platform moves forward, adding hex 
7 to the beacon position as seen by the head, and using the 
Meeult as a steering command for the drive motors. This 
results in maintaining the beacon at right angles to the 
erection of travel, in position 0, and the robot moves 
around the charger to a slightly different position but 
roughly the same distance away. With the obstacle hopefully 
now clear, Subroutine Align then realigns the robot with the 


Beacon, and docking continues. 


See LNIRUSION DETECTION 
gie robot's utility begins to develop with the addition 


Seeemeans to detect intruders and unwanted conditions such as 
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fire, smoke and toxic gas. The effectiveness of these 
detection sensors, their hardware interface, and the corre- 
sponding software plays a major role in the determination of 
the robot's actual worth as an autonomous sentry. The devel- 
opment of increasingly sophisticated but cost effective detec- 
tion methods which can operate from a moving platform has 
become a vital area of concern. 
On the prototype sentry ROBART, the software maintains 
the detection and interface systems in one of two modes of 
operation: Alert Mode or Passive Mode. In the passive mode 
the majority of sensors are enabled, but a good deal of the 
interface and drive control circuitry 1s powered down to 
conserve the battery charge. The robot mainly relies on 
Messtive infrared motion detection, visual motion detection, 
and hearing to detect an intruder, while at the same time 
memetoring for vibration (earthquake), fire, smoke, toxic 
gas, and flooding, etc. Some of these inputs are hardwired 
tO cause an alert (switch from Passive Mode to Active Mode), 
whereas others must be evaluated first by software, which 
then may trigger an alert if required. In the Alert Mode, 
all distribution buses are powered up, and the platform is 
Beaay to respond to input conditions, prosecute an intruder, 
Beco On patrol. Either mode can be in effect while recharging 
and recharging can be temporarily suspended if conditions warrant. 
The first intrusion detection system implemented on the 


prototype involved discriminatory hearing. A bandpass filter 
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is employed to selectively pass along to an audio amplifier 
those sounds likely to be produced during a forced entry, 
Such as breaking glass, sawing or filing noises, etc. More 
common household noises, such as those produced by a furnace, 
air conditioner, or refrigerator, are greatly attenuated by 
the filter, and therefore do not reach the threshold required 
to trigger the detector. The detector is hardwired to force 
the robot from the Passive Mode into the Active Mode if 
triggered, and this transition is subsequently detected by 
the software. Directional hearing sensors could also be em- 
ployed to assist in establishing the location of a detected 
disturbance, requiring only minor changes to the existing 
meme uLcry . 

The forward looking sonar used for collision avoidance 
can also be used in an intrusion detection mode when the 
platform is not moving by simply recording the range to the 
nearest obstacle. If an intruder subsequently walks through 
the sonar field of view and decreases this range, the soft- 
ware can respond accordingly. 

The addition of an optical motion detection system to the 
prototype provided even more capability. Three National Semi- 
conductor type D-1072 integrated circuits are employed to 
detect changes in ambient light level. These are special 
meepose chips incorporating a built in photodiode and plastic 


fens, and are completely passive, requiring no external light 
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source. The cone shaped detection zone created by the lens 
covers a two foot circle at approximately eight feet, and con- 
siderable range is possible, depending on background lighting 
conditions. The device is capable of operating over the range 
of 0.1 candlepower to 100 candlepower [Ref. 7]. 

The sensors are situated with their detection fields 
oriented so as to cover three slightly overlapping regions, 
left, right, and straight ahead with respect to the robot 
Mead position. This provides a broader detection field, and 
Since the sensor outputs are read independently by Data Sel- 
ector C, some rough information as to disturbance orientation 
1s available as well. 

These optical motion detectors are effective only if the 
vehicle is stationary, and are automatically disabled when 
the platform is in motion. Once motion ceases and the soft- 
ware secures the system from an Alert status, the detectors 
are re-enabled after a short delay to allow them to reset 
tO ambient room lighting. The number of sensor units can be 
increased to six for 360 degree coverage, as planned for the 
melle@w On version to this prototype. 

As the software 1s developed for the overall intrusion 
detection scheme employed by the robot, it soon becomes 
Separent that in most environments confirming indication 
from other sensors should be obtained to minimize false 
alarms. Since the optical motion detectors must be sensi- 


tive enougn to respond to light level changes resulting 
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from a person merely walking through the field of view, they 
= by nature susceptible to false triggering. When incor- 
porated in a fixed alarm system, these sensors may be mounted 
in locations chosen to prevent exposure to rapidly changing 
light conditions which might arise from sources other than 

an intrusion. When mounted on a mobile platform, however, 
they often may end up pointed directly at a window. In this 
Orientation, it is quite conceivable that the detector could 
be tripped by the headlights of a passing automobile, or 
flashes of lightning, for example. 

Eemidariy, overhead flight of propellor aircraft can 
sometimes intefere with the operation of ultrasonic trans- 
ducers. Hearing sensors might inadvertently respond to 
claps of thunder, or sudden noise generated in an apartment 
overhead by the dropping of an object onto the floor. The 
robot must be able to distinguish these incidents from a 
Beas intrusion situation. If the response to the initial 
indication is used to direct the attention of all sensors 
to a possible alarm condition, perhaps through movement of 
the vehicle to a better vantage point, then all sensors can 
be polled for secondary indications confirming the likeli- 
meea Of an intrusion. 

A third means of intrusion detection or confirmation is 
incorporated through use of the parabolic near-infrared sen- 
sor described in Section II-D. Mounted on the head, this 


active sensor was originally intended for locating obstructions 
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around the robot out to a maximum range of six feet for colli- 
sion avoidance purposes. While this range is rather limited, 
Demep@sitioning itself in the center of an average nine by 
Ewelve foot sen. the robot can perform a sweep of its head 
and cover a substantial area. Should a return be present 

Eiat Was not previously there, the possibility of an intruder 
rises. This sensor is primarily used to confirm a presence 
previously detected by another sensor, because of its high 
resolution and maneuverability, and not as a primary detector 
due to its short range. 

The most sophisticated sensor for intrusion detection 
used on the prototype 1S a passive true infrared detector 
sensitive to body heat. This is an off-the-shelf unit manu- 
factured by Colorado Electro-Optics, and has a maximum range 
of fifty feet. The device is sensitive to any temperature 
med@@omt OCCUrring within its field of view such as that 
created by an intruder walking through the area under surveil- 
lance. The detection zone fans out to a width of twenty feet 
at maximum range. 

This unit is intended to be mounted in a stationary posi- 
tion, but was found to be stable enough in an average house- 
hold temperature environment to operate when the vehicle was 
in motion, due to the low speed of advance associated with 
the prototype. A passive infrared sensor, in general, is 
Meee Sensitive to cross-walk and least sensitive to distant 


objects moving directly towards or away from the unit [Ref.8]. 
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Pigure 21. Photo Depicting Sensor Location. Passive infrared 
detector is visible in white enclosure at top center. Directly 
below this can be seen the near-infrared parabolic proximity 
detector. Microphones for discriminatory hearing are located 
on left and right sides immediately above plexiglass dome. 
Three optical motion detector chips are mounted directly 

above the three photocell collimating tubes, inside dome at 
top center. Speaker is for speech synthesis output. 








If the head is turned to one side as the vehicle 1S moving, 
the presence of an intruder on that side fond be detected 
due to relative motion with respect to the vehicle. An 
obvious advantage would therefore be realized by mounting 

a detector on each side of the vehicle, in addition to the 
one mounted on the head. 

In addition to remaining motionless while the platform 
is moving, the head can be slowly turned while the vehicle 
Memecationary, scanning a circle of fifty foot radius. This 
feeea allow the prototype to enter a doorway and stop, and 
from this position scan the room one time by merely turning 
its head. An intruder present would be instantly detected, 
even if able to remain motionless during the sweep. 

The use of this infrared sensor in non-stationary appli- 
cations as described above will vary somewhat with back- 
ground temperature. Under reasonably cool (65 to 70 degrees 
F) ambient conditions, the human body, being an excellent 
emitter of infrared energy, will produce a striking tempera- 
ture gradient. If vehicle velocity and the rotational speed 
of the head are kept relatively low, false triggering of the 
Sensor can be minimized. Since the robot reacts to this 
triggering by merely stopping its motion and bringing other 
Sensors to bear for confirming indications, one or two false 
alarms create no real problem. After a brief period of 
Waiting the robot will conclude there was nothing there, 


and resume the patrol. 
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im the event confirmation of an intrusion occurs, the 
robot warns the intruder to leave the area through speech 
Semenesis. The software can be structured accordingly to 
effect whatever action is desired by the operator, but on 
the prototype version a siren was set off if the intruder 
Was still present after a ten second wait. Exactly what an 
autonomous sentry should do in this situation depends greatly 
on the application. A central monitoring station could be 
alerted via a digitally coded radio transmission that an 
intruder had been detected, subsequently setting off the 
Mmeeerding security alarm, and possibly notifying police. 

This monitoring station could perhaps keep track of sev- 
Meeeeerobots patrolling on different floors, or in Eee 
areas of a large industrial plant. Each robot could period- 
Meeiy transmit its location and status, thus providing a 
Means for the central station to be alerted should a robot 
become disabled. Human guards or other robots could then 
be dispatched to the scene to evaluate the situation. 

In this regard it would probably be more cost effective 
Memprovide two robots, one for each floor of a two story 
Siding, rather than attempt to create a single robot cap- 
Mere Of climbing stairs and intended to patrol both floors. 
In industrial applications, elevators are likely to be em- 
ployed within the building anyway, and relatively simple 
radio links would place these within the robot's control 


if situations warranted traversing between floors. 
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mee sedAVIOR SELECTION AND ALARMS 

Once the mechanical functions of a prototype robot have 
been implemented and interfaced to the microprocessor in 
such a way that they can be controlled, attention must turn 
to the software which will dictate the actions of the entire 
System. Thus far only specific subroutines which manipulate 
eontrol lines to perform given functions, such as drive wheel 
Meettioning, tracking, docking, ete., have been discussed. 
What 1s needed now is an overall operating system to call 
these subroutines in the proper order to accomplish complete 
tasks, as required by conditions internal or external to the 
system. 

In addressing this need a means should be provided to 
Meee into account the priority of the task being performed, 
and allow termination of that task and substitution of another 
Maiener priority if conditions so dictate. Additionally, 
in the event no conditions are present which would require 
meron, What then should the robot's behavior consist of? 
Clearly, to have the prototype continue moving about in a 
random fashion would be a great waste of battery power, and 
possibly annoying as well. 

in a more sophisticated machine, these problems would be 
solved as a normal consequence of the software which made up 
Bieemachine's “artificial intelligence," with a goal oriented 


program in execution that allowed for recognizing needs, 
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mea planning ways in which to satisfy those needs. An elab- 
orate model would be constructed of the machine's perceived 
environment, as well as its own condition, and through vari- 
ous means the system goals could be broken down into achiev- 
able subgoals, with alternate schemes tested first within the 
model itself, until a workable solution was reached. The 
Mem Of correct choices which arrived at the desired end 
point and fulfilled the goal would then be used as a con- 
trolling program, and only at this point would it be exe- 
cuted, hopefully meeting with the same success as when the 
actions were only simulated within the model. 

In a system designed around a single microprocessor, 
however, this 1s not always possible, unless the number of 
actions and sensory inputs is Kept small enough to allow the 
Meeeram tO rit in the available memory space. It was not 
the purpose of this prototype to serve as a demonstration 
platform for a very sophisticated AI program, but rather as 
Meee Veliicle for different type sensors, their interface 
circuits, and lower level assembly language routines to 
serve these sensors. As a natural next step a follow-on 
robot will be constructed to utilize these already developed 
Semeepts, with a more powerful host computer directing the 
actions of several microprocessors. 

Therefore a means was implemented in assembly language 
B@rtware to provide supervisory control of the prototype, to 


yield a reasonably intelligent process of goal achievement 
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through execution of ordered sequences, each controlled by 
its own subroutine. Just as the system is equipped with a 
library of specific subroutines, 1t 1s now provided with 4 
set of predetermined behavior routines, each made up of the 
appropriate subroutines, arranged in the proper order to 
accomplish a certain task. 

The software is structured around one main loop which 
controls branching to the various behavior routines. These 
routines each have their own exit requirements, which when 
menallow return to the main loop, at which point the next 
routine will be selected. The same routine will not be 
Selected twice in succession, and certain sensory inputs 
Can alter the probability of a routine being chosen. This 
Hearn Loop is first entered via the Cold Start Initialization 
Bemeine (see Figure 22) when the system is brought on line 
meee Operator. 

Being this startup voice output is used to announce 
status as individual systems are energized and tested by 
meee cPU. The operator will be instructed to correct any 
discrepancies that are detected, such as Enable/Disable 
Switches in the wrong position. Any system failures will 
Cause the CPU to initiate shutdown procedures. Once the 
Startup sequence has been satisfactorily completed, the 
main loop is entered and a behavior routine selected for 


execution. 
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meomre 22. Software Structure for Prototype Robot ROBART. 
Interrupt Requests (IRQ) deal with all alarms and collision 
avoidance sensors. The Non-Maskable Interrupt routine is 
used to implement a real time clock. The main code initial- 
izes the system, powers up and checks interface Gilreui try 
and handles behavior routine selection. 
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While these behavior routines are not in themselves re- 
cursive, each does have the ability to call within itself any 
of the others, which then appear to that routine only as big- 
Beeesubroutines. In addition, provision 1s made to call rou- 
tines in a given sequence. This sequence could possibly have 
been determined by some goal oriented program which selects 
a succession of behavior routines, each designed to accom- 
plish an intermediate task required for the achievement of 
some ultimate goal. The system is always aware of the last 
routine executed, any routine that was interrupted by one of 
higher priority, and the next one for execution, if appro- 
memacte. If the next routine is not specified, then one is 
BMesen at random, but within the constraints dictated by 
internal and external conditions. (As an example, non- 
critical routines involving speech are not chosen if the 
room is dark, indicating that the household has retired for 
fie Might.) 

The behavior selection process (performed by the software 
commencing at label beh.sel) chooses a routine according to 
an elaborate scheme designed to provide the needed control 
features previously discussed. Upon initial startup, the 
First routine is randomly chosen from a possible range of 
peco 15. This range is further decreased to include only 
Mem@eanes 0 through 7 if the Drive Power switch is in the off 


Meemtion, as routines 8 through 15 involve vehicle motion. 
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The number of the chosen routine is stored in Register Last, 
and the routine is performed until its exit requirements are 
met. The system is then returned to standard conditions 
(Passive versus Alert status, with drive system secured, and 
Interrupt Channel A disabled). If the randomly chosen rou- 
tine turned out to be unsuitable for performance at the time 
chosen, as in the case of the example above involving the 
darkened room, it would not be performed. In any event, the 
software then loops back for selection of the next routine. 
Operator Control Service Number 6 can be used to allow 
the operator to manually set the contents of Register Next, 
em@emctnus Specify the next routine, within the range 1 to 15. 
In the selection process (see Figure 23), Register Next is 
first checked to see if a choice has been specified by this 
Seesome other source. If not, then Register String, the 
Mmie>sct OL Sixteen consecutive registers, is checked to see if 
a series of subsequent behavior patterns has been requested. 
Tf Register String is not set, then the Hostile/Friendly 
Beacon On the prototype front panel is checked. If this 
Meeeee iS in the up position, it will force the selection 
of Behavior Routine Number 1, which monitors for intrusion 
(see Section II-E). If none of the above three sources 
Specifies the next routine, however, a random choice is 
again made, compared with Register Last to ensure no back- 


to-back duplication, and then performed (see Figure 23). 
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If Register Next had been set, the routine number con- 
tained therein would have been chosen immediately. Alterna- 
tively, if Register String had been non-zero, its value 
would have become the next routine, and each register value 
shifted down one location in the sixteen consecutive regis- 
Mees beginning with String. (That is, Register String would 
Melee on the value of Register String + 1, String + 1 the 
Meee Of String +2, etc.) The last entry in the list of 
routines to be performed must be zero, and obviously only 
fifteen routines can be specified at a time. Each time a 
value is taken from the Register String, the other register 
contents each move down one to replace it, until finally 
String takes on the value of zero ($00) and is no longer 
Set. 

The termination of any routine in operation before its 
normal completion point is a desired feature in this behavior 
selection process, whether requested by the software itself, 
or externally requested by an operator. This is implemented 
through Subroutine Termin, which checks the external ENTRY 
button and sets Register Exit if the button has been pressed. 
Register Exit is then checked, and if non-zero, having been 
set by Subroutine Termin or elsewhere in the software, the 
current routine is terminated. 

When a critical routine is terminated by Subroutine Termin 
TO allow a higher priority routine to take place, provision 


must be made to allow for resumption of the original routine 
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Been completion of the substituted routine. This is accom- 
eeasned by saving the interrupted routine number in Register 
Seeeng, and is done by Subroutine Ph.strg. This subroutine 
manipulates the sixteen consecutive registers beginnings at 
String so as to provided a stack external to the 6502 in 
which information can be saved. Just as the register con- 
tents move down as routine numbers are taken from String, 
they move up one register location each time a routine number 
is saved. This stack is limited in that if more than fifteen 
routines are saved, the original numbers fall off the end of 
the stack and are lost. The sixteenth register contents are 
always maintained at zero to flag the string end. 

While the random selection process is limited to routines 
0 through 15, the total number of performable routines is 
limited only by available memory space. The randomly sel- 
ected routines are designed to produce behavior actions 
during periods where specific routines, such as recharging, 
are not needed, and sixteen routines are more than enough 
Mer this category. The routines above 15 deal with specific 
Situations requiring definite action on the part of the 
robot, and can be neither randomly chosen nor selected by 
Seerator Control. 

The first of these, Behavior Routine Number 16, deals 
with all alarm conditions. High priority alarms, such as 
smoke, fire, flooding, A/D overflow, etc., all cause inter- 


@ems Via Interrupt Channel B. However, the interrupt 
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routine which polls Channel B takes no action other than to 
set Register Next to 16, set Register Exit to terminate the 
current routine in execution, and then disable Interrupt 
Channel B before returning from the interrupt. Upon return 
m@eem interrupt, Subroutine Termin in the routine under ex- 
ecution will detect the fact that Register Exit is set, and 
terminate the routine. Since Next was set to 16, Behavior 
Routine Number 16 immediately follows, and it decides the 
appropriate subsequent Behavior Routine to deal with the 
paeaem Condition. This choice is based on the value of the 
interrupt index, Register Q, which was set in the original 
Bieerrupt polling routine for Channel B. As an example, 

a low battery condition will cause an interrupt read on 
meet | of Data Selector B. With the interrupt index 9 

set to 1, Behavior Routine 165 will announce the low battery 
condition through speech synthesis, and then set Next to l/7. 
Behavior Routine 17 then follows, and consists of the beacon 
acquisition and tracking subroutines, which are used to dock 
Mien rebot at the recharging station. 

It is important to keep in mind that all Channel B 
Mieerrupts are disabled by the interrupt polling routine if 
any of the Channel B interrupt lines go high. Behavior 
Routine 16, which deals with these interrupts, must either 
eliminate the interrupt source, or individually disable the 
@aput if another routine is going to be called to deal with 


the source. An example of this latter case is the low 
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battery interrupt. Since the last action taken by Behavior 
Routine 16 is to re-enable Channel B Interrupts, the low 
Battery interrupt must be gated out first so that it will 

be ignored while Routine 17 is selected to effect recharging 
or another interrupt would occur first and recharging could 
never take place. This is done by hardware circuitry on the 
Monitor Board. As an alternative example, the smoke detector 
interrupt is handled by Behavior Routine 16 by simply announc- 
ing that the smoke alarm has tripped, and advising personnel 
to evacuate the room. Behavior Routine 16 then re-enables 
Interrupt Channel B and returns, and if the detector is 

eee an an alarm state, another interrupt occurs, and the 
process repeats. If the process repeats more than four 
times, a siren is activated as a secondary alarm. 

Additional routines above 17 can similarly be employed 
MemaccOomplish specific tasks, just as 17 is responsibie for 
Seemting with the charger. It should be noted that Routine 
17 assumes the robot is in the room with the charger. 
Another desirable task therefore could consist of going 
memmeae room with the charger in it. This theoretically 
could be preceded by the task of determining where the 
room with the charger was. These three task numbers could 
then be loaded into the stack created at Register String for 
performance in the proper sequence to locate and dock with 
the charger. If any of these tasks had to be interrupted 


to deal with a higher priority need, its number would be 
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Meeed back into String, so that it could be reinitiated when 
needed, preserving the validity of the sequence. A necessary 
Meemt tO make is that each intermediate task must always be 
aware of when its particular sub-goal has been reached, and 
structured so that if a task is scheduled to achieve a result 
that has already been achieved, the next task will be called. 
It should be apparent that this arrangement has a great deal 
Samelexibility and potential as a first step in providing 
realistic supervisory control for a single microprocessor 
system. The actual Behavior Routines themselves could be 
stored on a floppy disk, and read in one at a time as needed 
by the robot as it moved about. This would allow for easy 
modification and addition of new routines by simply changing 
mae disk. 

The stack created at Register String works like a con- 
ventional CPU stack from the standpoint that data is always 
placed on the bottom of the stack, and likewise removed from 
Beem pottom of the stack, ina “last in, first out" sequence. 
However, it would be advantageous in this application to be 
able to add data to the other end or top of the stack. 
Routine numbers thus inserted would be performed at the 
end of the already specified sequence, rather than inter- 
rupting it. This is relatively easy to accomplish through 
a subroutine that merely adds data to the first clear regis- 


meeeencountered in the group beginning at String, and in 
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fact the number of registers can be increased if desired to 
Meovtcae for a bigger stack. Considerable sophistication 
could be achieved with 32 registers. 

Now let's assume that there is a separate program in 
Operation, whether on the same or a different computer. 
This program could be tasked with constantly monitoring the 
mepot'S environment and internal conditions, and assigning 
appropriate goals for achievement accordingly. As previously 
discussed, it could then work backwards from the desired 
goal, and establish the required sequence of subgoals, being 
aware of the Behavior Routines that it has in its inventory 
and what particular subgoal each was designed to achieve. 
In a very sophisticated system these Behavior Routines could 
be theoretically tested first in a system model to ascertain 
their actual effect. In any event, once the correct sequence 
of Behavior Routines was determined, their associated Routine 
Numbers could then simply be placed into the Stack set up at 
Register String, and they would subsequently be called and 
meerormed in the appropriate order to achieve the desired 
goal. While the Behavior Routines themselves represent 
Canned solutions to specific problems, the sequence in which 
they are performed is determined by the robot based on the 
Overall objective. It was the purpose of the first phase of 
this prototype development to provide the means to implement 
the chosen sequence, while the supervisory program which 


determines the sequence is to be developed at a later date. 
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G. NAVIGATIONAL PLANNING 

The ten near-infrared proximity detectors described in 
Section II-D are sufficient in themselves to allow the vehicle 
to make random patrols of a household. The navigational loop 
Simply instructs the prototype to move directly forward as 
Hong as no obstructions are detected, and the collision avoid- 
ance system takes over to avoid obstacles as they come into 
View of the sensors. The resulting motions of the vehicle 
Will eventually carry it from room to room, but in a totally 
unpredictable and extremely inefficient fashion. 

Obviously a robot intended to serve in a security role 
must be provided with an intelligent means of navigating, 
if for no other reason than to minimize drive and steering 
motor power consumption. It would be no great challenge to 
Outsmart a mechanical sentry that relied on random motion 
to carry it from place to place. Therefore the development 
of a more sophisticated means of determining the vehicle's 
course becomes an important milestone in its evolution 
meward true autonomy. 

The most effective approach to solving this problem in- 
volves the development of a memory map wherein the machine 
Can encode information about its environment as it moves 
about. A simple way to do this would be to assign a single 
byte in memory to each square foot of floor space, as pre- 


sented by Weinstein in the book "Android Design" [Ref. 9]. 


ieee: 








An average room ten feet by twelve feet would require only 
120 bytes, and thus an array representing an entire house- 
hold floorplan could reside in less than 2 kilobytes of 
memory space. Over a period of time the robot could fill 
myethie originally blank map with probability codes reflect- 
Meee tne chances of finding an object in a particular square. 
mer example, a code of zero could indicate that there has 
never been an object detected in that location. Code 1 might 
mean there was once, but not always, code 2 indicating there 
probably is, and code 3 meaning there always is an object in 
that square. The robot can reassign probability codes as 
conditions change over a peo of time. A special code 
could be preassigned by the system programmer to indicate 
areas the robot must never traverse, 1f so desired. 

With a memory map of this type oon could be devel- 
oped similar to those used in computer games (such as Othello) 
Bemlocate clear pathways through a room full of obstructions. 
The geographical position of the recharging station could be 
recorded, as well as door openings and hallways. Planned 
routes for patrolling could be preprogrammed, or generated 
by the software. 

The main hurdle to the implementation of a scheme of 
this sort results from the fact that this concept requires 
the machine to know its location at all times, as well as 


its orientation in that spot. There presently exists no 
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inexpensive way to provide this capability. Various means 
have been suggested, such as using sonar to establish the 
minimum range (and hence a perpendicular line) to each wall, 
and through geometry calculate position in terms of memory 
map coordinates. While this sounds plausible in theory, a 
glance around the average room reveals a significant number 
of drawbacks in the form of doorways, windows, and upright 
furniture which would invalidate the sonar data and greatly 
complicate the needed software. 

Therefore, as a first step the prototype was given the 
ability to create a relative rather than absolute model of 
Bae Objects around it. By turning its head and recording 
fae) DOSsition of obstructions within the field of view of 
sensors mounted on the head, as it rotates from side to 
Side, the robot can then examine this much less sophistic- 
ated memory map for information previously unavailable. 

This allows the vehicle to navigate ina far more effective 
manner while efforts continue to develop hardware to assist 
in absolute position referencing. 

This relative model requires only 16 bytes of memory 
pace, one for each of the points of resolution of the head 
BesitioOn A/D converter. Since each byte consists of eight 
bits, elght pieces of information can be stored for each 
pie shaped sector of the robot's perceived world (Figure 24). 

The most obvious piece of information needed would be 


the presence of a near-infrared return as detected by the 
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parabolic dish sensor, mentioned in Section II-D, which has 
a range of six feet. Any object out to that distance would 
be recorded by setting the designated bit in the memory 
location assigned to that specific head position, say bit 
fe Bit 1 could represent the presence of a bright light 
source when set, bit 2 could be set if the infrared heat 
Meeec.Or Output went high, bit 3 could represent a sonar 
Bourn from a transducer mounted on the head, and so on, 
ienavyoid Gonfusing the issue, in the following discus- 
Sion only two pieces of information will be considered: a 
near-infrared return from the parabolic sensor, represented 
Byesetting the lower four bits, and the presence of a bright 
immence source, represented by setting the urper four bits 
of the appropriate memory location. 

The first step in the implementation of navigational 
planning based on this relative model involves writing a 
subroutine (Subroutine Survey) to turn the head to position 
Memo full right) or position fifteen (full left), whichever 
as closer. The head is then swept once through the full 
range of positions, and the software polls the appropriate 
sensors in a repeating loop until the sweep is complete 
Memo seconds). If any sensor output is found to be high, 
the head position is read, and the appropriate bits set in 
the corresponding memory location. Upon completion of the 
sweep the data in memory can be used in decision making sub- 


POutines that ultimately dictate the robot's actions. 
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One such subroutine is Subroutine Sort, which runs 
through the memory locations and determines the starting 
and ending boundaries of any obstacle-free zones, expressed 
in terms of head position. This can be followed by Sub- 
routine Choose, which selects the largest free zone, and 
Subroutine Center, which calculates its midpoint. This re- 
sulting value can be used as a steering command, maneuvering 
Pee Vehicle into uncluttered space away from obstructions. 
[eis also very useful in locating doorways. 

Figure 25 shows a sample printout of a test harness 
written during the development of these subroutines. The 
register contents following a sweep of the head under control 
of Subroutine Survey are listed, and immediately below are 
shown the starting and ending boundaries of the two largest 
obstacle-free sectors. The larger of these sectors is then 
chosen and its midpoint subsequently calculated, as marked 
Si tae figure. 

While the time required to update the contents of this 
relative memory map is only 3.5 seconds, it is still long 
emouen to allow the robot's position and orientation to 
Change considerably. Changes in position have minimal 
effect on the validity of data obtained while the vehicle 
is in motion due to its very low speed of advance (26 feet 
Pemesecond). Changes in orientation can be significant, 


however, due to the sharp turning angles possible (up to 
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Figure 25. Sample Output of Test Harness 
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80 degrees). The problem is further complicated as the sweep 
eould be in the direction of the turn, or opposite to the 
maening direction. The result is invalid data in either case. 

An additional complication can arise if an interrupt 
should occur during the sweep. The head is turning under 
memeaware control, and will continue to do so even if the CPU 
mMeeGalled away to service an interrupt. Interrupts cannot 
be disabled during the sweep because the close-in collision 
avoidance strategy is built up around the near-infrared prox- 
imity detectors which all generate interrupts. Therefore 
there exists the very likely prospect that regions free of 
obstacles could be recorded which didnot really exist, simply 
because the CPU was busy with an interrupt and did not get 
around to polling the sensor. Since only 250 milliseconds 
are available during the sweep for processing information on 
each pie shaped sector of the model, as compared with the 
five or six seconds needed to execute some collision avoid- 
ance interrupt sequences, the problem is significant. 

The first problem arises due to the length of time in- 
volved if the head must sweep out the entire domain of six- 
teen sectors. A more practical approach would be to limit 
the sweep to those sectors directly in the intended path. 
Since the sweep limits are determined by software, this is 
easily implemented. Subroutine Radar sweeps the head back 
and forth between sectors 6 and 9, and the robot moves for- 


ward as long as no objects are detected. If an object comes 
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into view on the left, the course is adjusted slightly to 
the right, and vice versa. Should the entire four sector 
region become blocked, then the vehicle comes to a halt and 
Berrtorms a complete sweep re an attempt to locate eae clear 
each . 

Since the total time required to update this abbreviated 
Meee! 1S significantly less than 3.5 seconds, and since turn- 
ing angles are kept within 40 degrees as opposed to 80, the 
chances of loading invalid data are greatly reduced. There 
remains only the task of integrating this long range naviga- 
meOnal planning process with the close range collision avoid- 
ance system. | 

Essentially what is needed is a means for the navigational 
loop to know when an interrupt has occurred, so that the data 
in the model can be ignored, and the model updated. Since 
this requirement was anticipated at the time the interrupt 
routines were written, the solution is relatively simple. 
Register IRQ.num keeps track of the number of collision 
avoidance related interrupts, incremented each time by the 
IRQ routine itself. Therefore, if this register is checked 
at the beginning of an abbreviated sweep, and its value is 
the same upon completion of the sweep, then the data recorded 
during the sweep is valid, as no interrupt occurred to dis- 
tract the CPU. If the value is not the same then the model 


1S cleared, and reflects no obstructions present. 
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This may indeed not be the case, but the situation will 
be remedied quickly as the next sweep is performed, provided 
emother interrupt does not take place to invalidate it also. 
The robot moves straight ahead during the interim. If an- 
other interrupt does occur, however, the collision avoidance 
routine takes over anyway, and so the robot responds under 
interrupt control to move away from the obstruction. Once 
clear, the software returns to the navigational loop and the 
Sweep resumes. 

Subroutine Radar can be called while the vehicle is in 
motion, for advanced information on what's out ahead. Inter- 
epee are not disabled during the sweep, but rather given 
priority, with the sweep information ignored if an interrupt 
Seeurs. subroutine Survey, on the other hand, is called 
only when the platform is stationary, for a complete picture 
@f the surroundings, and interrupts are disabled for the 
feo seconds required for the full sweep. This approach 
allows the two systems to work together without conflict, 
the longer range infrared sensor ylelding to the close 
range proximity detectors when a collision threatens. 

The robot now has the ability to look out and see 
ebstaciles four to five feet in front of it, and subsequently 
alter course so as to pass to one side. Should it become 
boxed in, it has the ability to stop and scan through the 


entire range of head positions for a clear zone. This 
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offers a great improvement over the purely random motion of 
Beeere, but still leaves a lot desired, if patrols are to be 
made in an orderly fashion. 

Again, what is needed is a means of determining absolute 
Mes2tion and orientation. Until such time as this can be 
practically implemented, the robot must make do with the 
information it has available. For a start, it can always 
Meterence off the position of its recharging station, which 
it can locate and positively identify. Secondly, hallways, 
being long and narrow, are relatively easy to recognize. 

If the household floorplan allows for positioning the re- 
charging station where it can be used to advantage in locat- 
ing the hallway entrance then the robot can systematically 
find the hallway and proceed down it, stopping at each 
doorway to check adjoining rooms while on patrol. The 

robot can determine its orientation in the hallway if told 
beforehand which direction affords a view of the beacon on 
the recharging station. With prior knowledge of where the 
rooms are with respect to the hallway, the robot can pro- 


ceed accordingly. 
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Til. HiGH LEVEL LANGUAGE FOR ROBOT CONTROL 


A mobile robot or platform is inherently more flexible 
than a physically restrained intelligent machine of the kind 
fmerecally found in industrial applications. This is not to 
imply mobility 1s more desirable, and in fact in many appli- 
cations it would unduly complicate things rather than improve 
them. For this reason, almost all research to date has been 
addressed towards fixed location devices and the control of 
their attached manipulators and end effectors. Here industry 
provides an immediate market and subsequently motivation for 
research aimed at improvements in design and application. 
ia response to this stimulus high level languages for robot 
control have emerged. These, although still primitive and 
Met altogether general, have indeed simplified control and 
programming in the systems for which they were written. 

While there exists a multitude of applications for 
mobile robots, the very nature of mobility dictates the use 
of greatly expanded sensory input, particularly in the case 
of a fully autonomous machine operating in unknown or even 
Sg@enging environments. Our present technology offers no 
cost effective means of implementing these sensory systems 
except where operation in hazardous environments intolerable 


to humans can be used to justify the extremely high costs. 
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As a result, fewer systems are in use and development 
lags those areas offering immediate monetary return. 

It soon becomes obvious that the inherent flexibility 
of a mobile system should not be compromised by the lack of 
a high level language to support it. Operations and func- 
tions performed by the system can best be implemented, ter- 
minated, or altered by either an operator, a programmer, 
or the system itself when the specifics involved are not 
addressed. For example, it should only be of concern 
that a left turn is called for, and not which values need 
be assigned to what registers, I/0 ports, and data dis- 
mempumors to effect that turn. Nor should the actuator 
control system that maintains the steering wheel in the 
Meettion called for come into play, whether it be imple- 
mented in hardware or software. All these details should 
be buried in the lower levels of the hierarchy, invisible 
at the top where decisions are made. 

For reasons mentioned earlier, a universal high level 
Bemedace strictly for mobile robot control does not exist. 
To support the work reported here, a high level language 
was developed for control of the demonstration platforn, 
the prototype robot nicknamed ROBART. Due to time and 
monetary restraints, and anticipated generalizations of 
the language, no attempt has yet been made to write a com- 


piler. Instead, its use is simulated through subroutines 
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acting on previously loaded registers in such a way that only 
minor changes need be made to make use of a compiler or in- 
terpreter should one be developed. 

It should be noted, however, that compiling a language 
for robot control is somewhat more involved with system 
Specifics than is immediately apparent. Compilers for con- 
ventional computer languages can be somewhat generalized by 
structuring in such a way that only the input/output addresses 
need be changed to adapt from one type of computer to another. 
As a simplified example, the command PRINT is universally 
Used to take information from a buffer and output it to an 
external device. Only the buffer location and the output 
port address will change from one system to another, and 
Meelods exist to facilitate handling that change. Ina 
robotics application, the computer to hardware interface 
must deal with much more than just a printer, keyboard, 

CRT, and mass memory, and so there are many more possibili- 
ties for change. One arm alone, for instance, can have six 
or more actuators, not to mention the sensory inputs needed 
for its operation. Additionally, the hardware now addressed 
1s much less standardized than conventional computer system 
hardware. Most printers, for instance, have either a paral- 
lel interface or a serial interface for data transfer, and 
mee Often directly interchangeable. Such is not the case 
With robotics hardware. The use of stepper motors to posi- 


tion an arm requires an entirely different scheme of control 
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than does an arm designed around DC servomotors, and there- 
fore the command RAISE ARM must result in completely unre- 
lated sections of code for the two systems. The question 
must also be addressed as to whether the controlling computer 
Memcalking directly to the arm positioning motors, or perhaps 
fo a dedicated microprocessor which in turn then talks to 

the motors, i.e., an 'intelligent' arm. The net result may 
very well be that while the language itself could be stand- 
ardized, the invididual compilers would have to be unique 

for their own particular application. A way around this 
would be to have the language address only the controlling 
computer, and standardize the controlling computer's inter- 
mfe-cO 1tS dedicated microprocessors for input and output. 
This would not be cost effective for small systems, and is 
not likely to happen anyway. 

This robot control language in its preliminary stage of 
development consists of operators designed to perform a 
Perticular function, usually discernible from the operator 
name. For example, the operator STOP terminates a process 
previously begun. Exactly which process depends on the 
parameter or group of parameters (not to exceed three) fol- 
lowing STOP. These parameters can be variables or constants, 
B@emere not needed for all operators. A list of operators 
and their associated parameters, if any, is given in 


Appendix E. 
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Operators can be listed sequentially as statements in a 
meoegram which in turn controls the motions Or Ehe robot. 
This program should not be confused with the high level 
artificial intelligence program which ultimately decides 
the behavior of the robot, and for which languages aiready 


Perst, such as LISP or ADA. 
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eT CONGEUSLONS 


The prototype robot ROBART, begun in August 1980 and 
completed in September 1982, was intended to function as a 
development platform for an autonomous robot sentry, with 
emphasis on testing appropriate sensors and their assoc- 
iated interface circuitry and software. The physical 
structure of the prototype therefore was chosen to allow 
Meeyeaccess tO internal components and circuitry, and con- 
sequently is not suitable for extended unsupervised opera- 
tion in a normal home environment. A body design hardened 
for survivability and free of external projections likely 
to snare on or be damaged by nearby objects is needed before 
a follow-on version of this prototype can be practically 
employed. 

Mme behavior selection process discussed in Section II-F 
provides the means for execution of the end results of some 
goal oriented artificial intelligence program which in fact 
could be running on a Separate computer. This higher level 
program could be tasked with evaluating the robot's environ- 
ment and needs, establishing goals, and then creating a 
software model in which to test the primitives represented 
in the various behavior routines. Each of these routines 


would be designed to allow achievement of a specific subgoal 
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under given entry conditions. When an appropriate sequence 
is found which reaches the desired goal, the corresponding 
routine numbers are pushed onto the stack and then performed 
in sequence. Since no higher level artificial intelligence 
program for determining sequences has yet been implemented 
on the prototype, the routine numbers are specified by in- 
terrupt service routines, based on the nature of the 


macerrupt. 
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V. RECOMMENDATIONS 


The development of this first generation model resulted 
in a fairly sophisticated single-microprocessor robot. 
However, results clearly indicate the need for future ver- 
sions to employ additional microprocessors to allow the 
controlling CPU more time to devote to overall coordination 
and planning. The specific functions of head Post cloning 
as well as steering and drive control currently implemented 
mamoueh rather limited logic circuitry could be better per- 
formed by individual dedicated microprocessors. This would 
Eaelow a full eight-bit resolution analog to digital conver- 
Pom tor the head position, resulting in 256 discrete posi- 
tlon increments, more than enough accuracy for processing 
information from head-mounted sensors. In addition, precise 
position error feedback would make velocity control of the 
head possible during positioning. 

With a microprocessor dedicated to head positioning, the 
circuitry contained on the Optical Board and Interface Board 
Number 5 could be upgraded to make use of eight-bit analog 
Boemcaeital converters to monitor each photocell output from 
the optical array, as well as the ambient light photocell 
output. The eight channel National ADCO0808 A/D converter 


would be ideal for this application, with four channels 
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left over for other uses. A tracking system comparing digit- 
ized photocell output to keep the head centered on the beacon 
would yield accuracy far greater than that achievable with 
the current circuitry. 

For the second generation prototype a steering and drive 
system utilizing two independently driven center wheels will 
be employed, with caster-type idlers at front and rear. This 
will eliminate the need for a separate steering motor and its 
associated position sensing A/D converter. Motor direction 
as well as individual motor speed can be precisely controlled 
mawough pulse width modulation circuitry, allowing an almost 
infinite range of turning radii for use in navigational and 
docking routines. A separate Microprocessor specifically 
tasked with controlling the pulse width modulation and mon- 
itoring the actual motor speed could provide precise turn 
radius, advance and transfer information to other dedicated 
microprocessors as well as to the controlling computer. 

An additional microprocessor assigned the task of deter- 
mining vehicle location could also maintain an updated 
Memory map of the surroundings, noting the locations of the 
battery recharging station, doorways, and other relevant 
items, in addition to obstructions. Dead reckoning infor- 
mation could be obtained from the drive and steering con- 
troller and combined with actual position information taken 
in by sensors and appropriate hardware. These memory maps 


could be down-loaded onto an onboard 5 1/4" disk when the 
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robot left the area represented. As 1t moved into a new 
Space a previously stored map of the new area could be sub- 
stituted. In this manner an entire floorplan could be repre- 
sented by a set of easily manipulated rectangular map arrays. 
The development of cost effective hardware to precisely 
determine position and orientation remains a crucial first 
mecep towards this end. 

The same disk storage device could also be employed to 
store all or at least some of the behavior routines or prim- 
itives. This would make considerably more routines available 
for the robot's use, and at the same time separate the pro- 
Peeing requirements for the routines themselves from that 
of the software which implements the routines. Behavior 
routines could be added or deleted by changing the software 
@meene disk only, with no modifications to the robot opera- 
ting system software which loads and executes the routines. 
The routine numbers specified by either interrupt routines 
or a high level artificial intelligence program would cor- 
respond to the file numbers of the routine software as 
Hoaded on the disk. The sequence of files to be loaded and 
executed would be stored in the stack created at Register 
Bering as discussed. 

For maximum efficiency the collision avoidance strategy 
@ietts entirety could be delegated to the supervision of a 


Separate processor. A multitude of information from tactile 
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and proximity sensors could be preprocessed before being 
passed on to the controlling computer for integration with the 
navigational planning software. In the prototype it was found 
that excellent protection could be obtained with the majority 
of near-infrared detectors oriented for forward coverage. 
Sensors situated at 6, 18, and 28 inches from the floor in 
a vertical column proved very adequate for obstacle detection. 
Columns situated as depicted in Figure 26 would give excel- 
Memercoverage of the platform's surroundings with sufficient 
Meeelution of a detected object's location for appropriate 
evasive reaction. 

It was found that these near-infrared proximity detectors 
Em@emmpetter suited to this collision avoidance application 
than ultrasonic sonar units. The divergence of an acoustical 
Deam by far exceeds the narrow cone of radiation from the 
high powered LEDs, and focusing or collimating devices can 
be employed to further increase the resolution of the near- 
gnierared detectors. Additionally, false triggering of 
these devices seldom occurs, whereas more sophisticated 
Circuitry is required to eliminate reactions to spurious 
Signals with conventional acoustical transducers. The 
directional characteristics of these infrared sensors make 
it possible to operate numerous devices in proximity to 
Saemeouner without cross coupling, which is again much 
Meeager tO eliminate with multiple sonar units. The sim- 


plicity and low cost of the near-infrared sensors makes 
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SIDE 
FORWARD 
MOTION 
Figure 26. Infrared Proximity Detector Sensor Arrangement. 


Top view of robot depicting cone-shaped areas of coverage 
for vertical columns of proximity detectors, with majority 
of sensors oriented for forward protection. 
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possible peripheral coverage to whatever extent desired for en- 
vironmental awareness with regard to surrounding obstructions. 
A proposed block diagram for this multi-microprocessor 
system is shown in Figure 27. Assembly language programming 
is well suited to the needs of the individual dedicated con- 
meollers, yielding fast and efficient code for the direct 
manipulation of output control lines and/or the reading of 
sensory inputs. The controlling microprocessor could also 
be programmed in assembly language, or even a robot control 
language as discussed in Section IV. This intermediate 
microprocessor would serve as an interface between the 
robot's subsystems and an eventual goal oriented artificial 


intelligence program written in ADA or LISP. 
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ARTIFICIAL 
ENGEL EC EGENCE 
COMPUTER 


INTERRUPT 


CONTROLLING DEVICES 


MICROCOMPUTER 





DRIVE AND HEAD MEMORY 
SEBESRING POSITION MAPPING 





Figure 27 Proposed Layouc of Multi-=microprocessor System. 
Individual dedicated microprocessors would be assigned speci- 
Tic tasks such as drive and steering control, head position 
control, memory mapping, etc. 
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Plume ron 

BO steering command 

Bl steering command 

B2 steering command 

B3 steering command 

Drive Power Relay (1 = on) 

Drive Direction Relay (1 = forward) 
Data read B (yellow) 


Data read A (red) 


Eine clon 
CO selector address (yellow) 
Cl selector address (red) 
C2 selector address (green) 
C3 selector address (white) 
Data Write l 
Data Write 2 (white) 
Data Write 3 (green) 


Head position latch enable 
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(Gs active low) 
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D3 head position (red) 
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Data read C 
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BO switch 1 (yellow) 
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B2 switch 3 (green) 
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m22 Peripheral Interface Adaptor 
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Speech 
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speech 
Speech 
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word 
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word 


Function 
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RCN-1 (1) 


Tape audio 
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select line 
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Preble x. & 


Doel sero lhi BUTOR PIN ASSIGNMENTS 


Pee SELECTOR A 

Mnput 00 - I/R proximity detector, left front 
mec Ol —- L/R proximity detector, right front 
ioe O2 = 1/R proximity detector, left side 
ioe OS —- I/R proximity detector, right side 
mee OF —- bumper impact, left front 

ieee OS — bumper impact, right front 


Input 06 - bumper impact, left side 


free Of —- bumper impact, right side 

Input 08 - feeler impact, left side 

Input 09 - feeler impact, right side 

Input 10 - bumper impact, left rear 

Input 11 - bumper impact, right rear 

Input 12 - drive overload monitor 

input 13 - not used 

Input 14 - I/R proximity detector, center front 
Ghput 15 - I/R proximity detector, center rear 
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DATA SELECTOR B 


Input 
eaput 
Input 
apt 
Input 
Pop wt 
meat 
mp t 
napaat 
np ut 
IC gjenege 
Input 
Input 
input 
Enput 


rap ut 


00 
Ol 
02 
03 
O04 
US 
C6 
OF 
08 
O09 
10 
da 


12 


14 


eS 


ambient light 
battery charge status 
A/D overflow alarm 

oS jyeolt ems monitor 

® volt Sus mMonpetor 
flooding alarm 

smoke alarm 

ire alarm 
drive power switch monitor 
selector check low 
selector check high 
vibration alarm 
toxic gas alarm 
approaching storm alarm 
net wused 


not used 
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Pata SELECTOR C 


put 
Enput 
en put 
Enout 
Input 
iia Sat 
Enea 
Part 
Ppt 
Input 
Lire ut 
aut 
Pag t 
nro ut 
imout 


iret 


00 
O1 
02 
03 
Qu 
05 
06 
07 
08 
0g 
10 
i 
12 
13 
14 


ano 


random digit 

hostile/friendly switch 

alert verify 

recharge monitor 

I/R motion detector 

optical target 

optical range status 

recharge probe status 

center visual motion detector 
right visual motion detector 
left visual motion detector 
bit 2 day of week 
bit 1 day of week 
bit 0 day of week 
AM/PM status 


parabolic I/R sensor 
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DATA DISTRIBUTOR A 


Output 
eacput 
Output 
Surtput 
Sue put 
ear put 
Output 
Output 
Puce put 
Soe put 
Output 
ouUeEput 
Suctput 
SucpUut 
Output 


output 


00 
Ol 
02 
03 
Oy 
05 
06 
07 
08 
09 
10 
11 
12 
13 


14 


not used 

continuous spot enable 
transmitter enable 

alert and hold enable 
[retire nOlprse nape 

strobe enable 

not used 

not used 

drive power relay 

not used 

low battery interrupt enable 
infrared motion detector enable 
visual motion detector enable 
position enable 

track enable 


scan enable 
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meré DISTRIBUTOR B 

eutput 00 - not used 

Siieput Ol - flood light timer trigger 
Peuput 02 - not used 

Preaeout O03 - not used 

Sieeec OF - not used 

Roeper OS = not used 

eecpuc 06 - not used 

Maeput 07 - not used 

Stmput US - not used 

Siepic OF - not used 

Piet 10 - not used 

Output 11 - siren mode A trigger 
Sitput 12 - siren mode B trigger 
Sutpue 13 - siren mode C trigger 
Gutput 14 - net used 


Oreput i> - not used 
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Pe PEND Ixy 


PPUS AvALLABLE: fOr CPU 


iyPM — 1 bit signal from a National Semiconductor Time/ 
Temperature Module (MA1026) indicates AM or PM. Also 


used to drive day of week counter. 


Day of Week - a three bit binary code from counter, allow- 
mmocrl tO establish what day it is (Sunday = 0, Monday = 1, 


etc.) for subsequent modification of behavior patterns. 


Ambient light - signal from photocell on top of head which 


indicates if room is light or dark. 


Temperature - sensing probe alerts CPU if ambient tempera- 


ture exceeds or falls below adjustable set points. 


Smoke - photoelectric smoke detection system. 


ieee sas - Figaro toxic gas detector. 


Fire - infrared fire detector with backup mechanical heat 
sensor. 
Vibration - seismic monitor indicates presence of vibration 


above an adjustable set point. Used for detection of earth- 
quakes and/or physical contact from external source. This 


Gimekion gated out when robot is in motion. 
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Visual Motion Detection - three National Semiconductor 
eee /2? Optical motion.detection chips signal the CPU if 
ambient light levels increase or decrease more than 0.1 


Bereent. 


Infrared Motion Detection - Colorado Electro-Optics sensor 
mounted on the head detects changes in heat energy radiated 


Pyesurroundings. 


Optical Vision - a three photocell array mounted on the 
Mead and used fcr locating and tracking the beacon on top 
of the battery charging station. Optical Board Target 
Output goes high when any of the three photocells acquires 


the beacon. 


Range - a special comparator compares the center photocell 
Gutput with an adjustable set point. Used to indicate 


oroximity of charger beacon. 


Near-infrared Parabolic Sensor - mounted on the head and 
therefore positionable 100 degrees either side of center- 
memes this highly directional active sensor is used to 
Pemeemrsn che location of objects out to a distance of 
Six feet. Provides excellent bearing resolution but gives 


femrndication of range. 


Flooding - spring loaded sensor indicates presence of water 


@m floor. 
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Discriminatory Hearing - bandpass filter incorporated in 
sound activated circuitry to respond to high frequency 
noises such as breaking glass, sawing, or filing, for 


Maerusion detection. 


Head Position (relative) - analog to digital conversion, 


represents position of the head as a four-bit binary number. 


memeve Status = six bit number which reflects the current 


steering command and drive direction status. 


Battery Level - two separate comparators indicate when 
battery is in need of a charge, and when recharging is 


Semplete. 


sonar - LM1812 based forward looking sonar transceiver, 
used in collision avoidance routines when robot 1s in 
motion and for intrusion detection when platform is 


Stationary. 


Infrared Proximity Detectors - ten transmitter/receiver 
units employing active source high power near-infrared 
LEDS sense returned energy to indicate the presence of 
obstructions around the vehicle, out to a maximum range 


Sees ianches. 


Contact Sensors - fourteen microswitches strategically 
Pes2cioned to indicate the deflection due to impact of 


spring loaded bumpers around the vehicle periphery. 
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Feelers - eight spring loaded feelers which sense object 


proximity for collision avoidance. 


Bus Status Monitors - numerous comparators which monitor the 
voltage on various power distribution buses and initiate 


shutdown procedures in the event of a malfunction. 


Seorm Monitor - lightning discharges detected by an AM 
Mmefdlo, Output is rectified and fed to a capacitor. Voltage 
level across capacitor is monitored by a comparator which 
alerts CPU and activates a 24 hour weather broadcast 


receiver in the event of an approaching storm. 


Probe Status - indicates presence of 14 volts on recharging 
probe when connected to battery charging station, activates 


relay to disable forward windings of tandem drive motors. 


Drive Overload - Comparator monitors the voltage drop across 
the drive power circuit breaker for signs of stalled drive 


wheel. 


Switch Position Verification - numerous comparators used to 
ensure critical switches are in correct position before 


Pif@etating actions dependent on associated circuitry. 


Speech Busy - 1 bit signal used to indicate to CPU com- 


pletion of previously requested speech synthesis output. 
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Operator Input - four bit binary code manually loaded via 
toggle switches on Operator Control Panel to allow operator 


to request actions or modify behavior of robot. 


ENTER Button - Normally open pushbutton to signal CPU that 
above switches have been set and are ready to read. Also 


used by operator to terminate current routine in execution. 


Hostile/Friendly Switch - used by operator to advise robot 
as to action desired in event an intruder detected. In 

Friendly position the robot responds with a greeting of 
Seem 'Hello'. In hostile position the robot advises 


Mmuemuder to leave the room and then sets off alarm. 


Alert Verify - used to confirm all previously powered down 
circuitry has come up on line as requested after transition 


from Passive Mode to Alert Mode. 
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AP PED x 2 


Rao ele Dole CclOR CURCULIRY OPERATION 


The near-infrared proximity detector system consists of 
a centrally located driver/detector board, with indicator 
LEDs, and remotely mounted transmitter/receiver units, re- 
Meeseaple for optimum placement. The driver circuitry is 
built up around two identical pulse generators, each pro- 
ducing a square wave train of 15 microsecond pulses with a 
piece repetition period of 1.7 milliseconds. These pulses 
drive into saturation an NPN transistor which gates a 
AC-880-A high power gallium aluminum arsenide LED emitting 
energy in the near infrared spectrum (880 nanometers). The 
Sevgece 215 supplied in a T-l 3/4 package. A 427 mfd electro- 
Mere and 10 ohm current limiting resistor are configured 
to supply an extremely heavy current flow (in excess of two 
amps) for the brief on-time, more than enough to destroy the 
LED under steady state conditions. The result 1s an intense 
pulsed output in a narrow cone, both desirable properties 
Pommam object detection system of this type. The two 
pulse generators are alternately enabled by a 955 astable 
multivibrator at about a 1 Hz rate, reducing power consump- 
tion by a factor of two, and eliminating pattern overlap of 


two adjacent LED's where desired. (There are certain cases 


ioe 





where pattern overlap is used to shape and/or enhance the 
detection field of a sensor intentionally, as discussed 
later.) 

The receivers utilized with this system each consist of 
fees photodiode incorporating a built in filter and lens 
system, with a cone shaped detection field roughly 45 degrees 
Emgeting the lens axis. The output of this photodiode is ampli- 
Meecretn~ough a L/C differentiator network, and then fed to 
a 741 (1/2 458) Op Amp (see Figure 28), which subsequently 
produces a positive spike for each burst of returned infra- 
red energy detected. These pulses are inverted by a 4049, 
which also serves as a threshold detector, and used to trig- 
ger a 555 monostable (1/2 556). This acts as a pulse 
me@eeener, providing an output pulse of approximately 100 ms, 
eegeriiuminating a red LED for circuit monitoring and adjust- 
ment. The 555 monostable output generates an interrupt on 
IRQ Channel A and is then read by Data Selector A. Six re- 
ceiver channels are provided, and all are commonly enabled 
or disabled by Data Distributor A output number 4 as needed. 
ihe circuitry is powered up automatically with the Drive 
Relay Board by Subroutine Dri.on. The receivers must sub- 
sequently be enabled by Subroutine I/Ren. 

Position resolution of the detector is a function of 
receiver sensitivity, the photodiode field of view, and the 


irradiation pattern of the high power LED. Of these, the 
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Near-infrared Proximity Detector Schematic 





latter is the most significant determining factor, as the 
irradiation cone of the infrared LED is relatively narrow 
(40 degree angle between half power points) with respect to 
the detection cone of the photodiode. The usable irradia- 
tion cone angle was experimentally determined to be roughly 
meeeeethat of the half power angle, yielding good resolution 
@mmpooyject location for a low cost system. 

Where desired, multiple emitters can be used to advan- 
tage to strengthen the irradiation field for greater range 
or sensitivity, and through careful placement of the LEDs 
it 1s actually possible to shape the detection zone to 
Beamer c the application. The prototype robot is little 
concerned with how tall an object is, but rather interested 
in horizontal resolution of its exact location. Therefore 
emitters were arranged in vertical columns to expand the 
Semeecr2oOn rield vertically, while creating no horizontal 
overlap. This technique greatly expands the proximity 
detectors' versatility at minimal additional cost as long 
as the LED patterns remain within the photodiode field of 
view. A rough guideline to ensure reliability was found 
to be one field width either side of a normal LED irradia- 
ieemeepactern, as shown in Figure 29. 

The near-infrared parabolic dish detector utilizes two 
adjacent LEDs for increased range and sensitivity, but the 


Spatial resolution here is primarily dependent on the 
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Heese 29. Near-infrared Sensor LED Overlap Pattern. Two 


emitters can be configured as shown to increase the vertical 
coverage of a single photodiode detector while maintaining 
the horizontal resolution required for collision avoidance. 
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Garectional property of the four inch parabolic reflector 
which focuses returned energy on the photodiode lens. The 
receiver circuitry 1S essentially the same as that employed 
in the proximity detectors, but with increased amplifier 
gain and an adjustable detector threshold implemented 
through use of an inverting comparator in place of the 4049 
inverter gate. Additionally, the 555 monostable pulse 
Stretcher is made retriggerable to provide a constant high 
output as long as pulses are received, free of intermediate 
resetting. This is a desirable property when the device is 
panned in search of a wall opening, for example, as a low 
output arises only when eee ons stop, and not moment- 


arily each time the 555 clocks out and resets. 
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POSSIBLE OPERATORS FOR ROBOT CONTROL LANGUAGE 


Parameters follow operator and are separated by a space 


SPlAK 


PEAT 


SEO CK 


POWER 


oT 


S CAN 


TRACK 


Yolece output word through speech synthesis 

First parameter is list number (1,2, or 3) 

second parameter 1s word number on list 

Third parameter D causes 40 millisecond delay first 
First and second parameters are required 

Third parameter must be D or not used 


Poe en eo tC Oltetmu, “danger. "wet 1s. 
word number 4C hex, no delay 
Poeun Pes 2ene OD Mem Cl Meus ~ linc hea2 -osed 


number OF hex, delay 40 ms first 


Delay before continuing 

First parameter is number of half seconds of delay 

First parameter is required 

second parameter C enables voice output of time of 

day if appropriate (see CLOCK) during wait 

second parameter must be C or not used 

Ex: Delay 9 Wait 4.5 seconds before continuing 
Postpone announcement of time until 
AENOrl Zed sat Later point 


Allows announcement of time of day at this point 
in program if appropriate Chour or half hour) 
No parameters are used 


Turns power on or off to interface and actuator 
Aa Peed my 

First parameter must be ON or OFF 

Bx) POWER Oo] powers up system 


TGQUSS Doel iIonts (oneor off 
First parameter must be ON or OFF 


Controls automatic scan system which rotates head 
back and forth 95 degrees each side of center 
First parameter must be ON or OFF 


Enables tracking circuitry for locating beacon 
Also enables head to scan for lock on to beacon 
Disabled by SCAN OFF 

No parameters are used 
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INITIAL 


Bike VE 


meow tT LON 


mole 


BEACON 


READ 


RANDOM 


CENeER 


ALIGN 


Usee 9 =o tm2tteiize system at start 
No parameters are used 


Used to enable or disable drive control circuitry 
First parameter must be ON or OFF 
Pee ORI YE ON enables drive circuitry 

does not start drive motor 


Used to position a joint 

First parameter must be joint identifier 

second parameter must be desired position 

Ex: POSITION HEAD $08 sets head facing forward 

Ex) POs UO Walet i: S00 sets steering full vight 


Matches steering angle to head angle 

When used ina loop with tracking function enabled 
causes robot to home in on beacon 

No parameters are used 


Used to control beacon on top of recharging station 
First parameter must be ON or OFF 


Inputs data from specified source 

fans paramecer must De Source identifier 

Second parameter can be used to further specify input 
See HEAD read head position (1 parameter) 
Bee er ek) peaduiaca setector A, 2nput ne. 11 


Creates a random integer 0 - 256 
First parameter is lower limit (inclusive) 
Second parameter must be upper limit (inclusive) 
No parameters returns random logic (high or low) 
Ex. RANDOM. 20.200 create random integer in 
range 20 to 200 
Ex: RANDOM randomly sets logical variable 
Determines head bearing to center of specified 
opening in wall, such as door or window 
First parameter specifies a bearing to left 
of desired opening to investigate 
Operation is then performed on first opening found 
£0 Yight of specified bearing 
Ee GrNthk sO Pand cemtersof first opening located 
to right of centerline ($08) 


Causes robot to align itself with beacon dead ahead 
Dy Sse uct este action requested by interrupt 
service routine, else no action taken 

No parameters are used 
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OKIRT 


MOVE 


HE Sh 


eben 


Causes robot to go around obstacle to left when 
homing on recharger, if such action requested, 
No parameters are used 


Controls Moetonwor robot Chassis 

First parameter must be drive motor command 

hemetiarewOoneces sretrORWARD, REVERSE, OPPOSITE. SAME, 
STOP 

Second parameter must be steering command 

Legal choices are LEFT, RIGHT, CENTER, SAME 


A variable (range 0 - 15) can aiso be used to 

specify intermediate steering angles 
Bx OVE Pe sWwARD Lard turn left moving forward 
Pee Eee ee Ook eo Ae reverse direction only 
Ex MOVE. GRE Sie SAME move backward, steering same 
Bx Oe eee eGr |. COneinve Motion. tian riche 
exe Oe somo P= Ger turn wheel to left, drive off 
ex; MOVE Same e205 HUOie whee sO pOs 2 mom: 70S 
Perform a canned test routine as specified 
First parameter is system to be tested 
De. footer AL perform canned test of head 


Dect Ohihe ci teu bry 
Ex: TEST DRIVE perform canned test of drive wheel 
DOS tetoOneme (el reit1 try 


Sets or secures system in ‘alert' mode 
4 


First parameter must be ON or OFF 
Peer eer Oe secures system to 'passive' mode 
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